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inertia and the lack of a velocity feedback. The inertia of the arm varies when the robot 
picks up or releases a load and the velocity would need a tachometer to be measured 
(expensive and not practical). One way to overcome those problems is to use an 
autoadaptive model to represent the plant. If the model "follows" the plant transfer 
function and both have the same input, the model can have velocity feedback and the 
effects will be reflected in the plant. The solution presented above was investigated and 
simulated in DSL by Kenneth R. Wikstrom, in his thesis from NPS in September of 
19S6. In the present research, a hardware and assembly software was designed and 
implemented based on the same structure mentioned in that thesis. The block diagram 
and autoadaptive algorithm were slightly modified and the plant was simulated in a 
dedicated analog computer. Two transfer functions were tested in the analog plant: a 
disk drive motor and a robot motor. 
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I. INTRODUCTION 



The positioning of a robot arm with just one degree of freedom can be a hard 
task if some constraints are imposed by the problem. Some of the requirements and. or 
restrictions can be: 

1. Accuracy. 

2. Minimum time. 

3. No overshoot. 

4. Velocity measurements are not available. 

5. Loads can be changed during operation. 

The accuracy and overshoot are common requirements and will not be discussed. 
The minimum time requirement is, in a way, incompatible with the lack of a tachometer 
to provide velocity measurements. How can the motor achieve the required position 
with no overshoot and minimum time without the knowledge of the velocity along the 
trajectory? It cannot be done unless the velocity can be guessed using the position 
information that is readilv available. In this case the curve following method can be 
used and the arm will be decelerated after some suitable point in the trajectory. 

What is the effect of changes in the loads? They will modify the inertia of the 
system and the transfer function of the plant. So, a real time identification algorithm is 
needed to detect inertia changes and update the controller. 

With these constraints and solutions in mind let us analyze the scheme proposed 
in Figure 1.1 . The plant represents the arm and motor of the robot. The model is a 
very' simple approximation of the plant. Both model and plant are driven by the same 
input. The identification algorithm receives both outputs, identifies the actual plant 
parameters and updates the model in order to keep CM and CS as close as possible. 

The theoretical scheme was treated in [Ref. 1] and will not be detailed here. 
However, the block diagram will be explained in Chapter II. The purpose of this 
research was to implement the real time system using a microprocessor, in a 
protoboard level. The model and controller were implemented by software in the 
microprocessor and the plant was simulated using analog hardware. 

When the desired position is achieved the controller, that was in "bang-bang" 
mode, can be switched to a linear compensator. This feature is important but was not 
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Figure 1.1 Simplified block diagram of the system. 

implemented in this thesis since our goal was to prove the feasibility of the 
autoadaptive algorithm using a servo system as a controller. 

The identification algorithm was chosen to be efficient and simple. The algorithm 
used in this thesis is found in [Ref. 1] and will be referred as "The Wikstrom 
Algorithm". It will be briefly discussed in Chapter II and the software implementation 
will be presented in Chapter III (subroutine "Walg"). 

The proposed system studied on a block diagram basis is presented in Chapter II. 
The 16 bits software design is discussed in Chapter III. Chapter IV presents the 
hardware for the analog plant and the microprocessor. The results are presented in 
Chapter V. The conclusions and some possible areas to be studied are treated in 
Chapter VI. The 16 bit program (called "Model") and the monitor program are 
presented in Appendices A and B. respectively. The procedures to operate the hardware 
are discussed in Appendix C. 

The Z-SO microprocessor was chosen to implement the system for three main 
reasons: 

1. The monitor was atreadv developed and. with small changes, could provide all 
the support needed to run and debug the soltware. 
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2. The author is very familiar with this microprocessor. 

3. The time requirements to operate a robot arm are not a constraint to the use of 
this microprocessor. On the other hand, the idea behind the model. controller 
and algorithm is still valid for a faster microprocessor. 

All the software was developed using the Z-100 and Data 1,0 in the Digital Lab. 
The programs were stored on (loppy disks, under CP/M operational system, and 
transferred to EPROM's via Data I/O. Once in EPROM's they were installed in the 
protoboards and then executed using the monitor. The debugging process was done 
using some features of the monitor that will be explained later on. 

The microprocessor and interfaces treated in this research can be considered as 
individual parts of a large system. Suppose a robot with multiple arms, mechanically 
coupled by joints. Each arm will have a terminal microprocessor (TM). This 
microprocessor implements the model, controller and updating algorithm accomplished 
in this thesis. The position input for each arm is commanded by a central computer. 
This command is applied directly to the corresponding Terminal Microprocessor, as 
shown in Figure 1.2 . 

The inputs to the central computer (CC) are the actual and desired (future) 
position of each arm. Based on this data it calculates the best trajectory for each arm 
and sends the individual position command for the TM's. The central computer does 
not worry’ about changes in the inertias or other factors that can occur in the 
individual arms. These problems are solved by the terminal microprocessors. 
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Figure 1.2 The Central Computer and the Terminal Microprocessors. 



II. THE PROPOSED SYSTEM 



A. INTRODUCTION 

The entire system can be separated in three different areas: model, plant and 
algorithm, as presented in Figure 1.1 . However, physically, there are two main parts: 
the digital microprocessor that contains the model and algorithm, and the analog 
implementation of the plant that represents the robot arm. 

The whole system is depicted in Figure 2.1 and the only difference between this 
one and that presented in [Ref. 1] is the input of the plant. In [Ref. 1] the plant input is 
XDOTE and here is V. This choice simplifies the hardware of the plant and still keeps 
the requirement that both model and plant have to have identical inputs. 

B. MODEL AND CONTROLLER 

The simple model that tries to approximate the plant consists of two integrators 
and a constant gain. Km. as shown in Figure 2.2 . The servo mechanism with velocity 
curve following and "bang bang" amplifier that was shown in Figure 2.1 belongs to the 
controller. 

Now that the controller is separated from the model, let us go back to Figure 2.1 
and examine every block. The input of the regulator, R. is a step command that 
determines the angular movement of the robot arm. The error. E. is the input of the 
curve . The curve approximates the deceleration curve of the motor and is a parabola. 
Mathematically, we have 
XDOT = AV E , where A = KlV 2.Km.Vsat 
Vsat= saturation limit of the amplifier 

Thus, from the servo error and the knowledge of the system, the desired velocity , 
XDOT, is computed by taking the square root of the error and multiplying by A. This 
velocity is compared with the actual velocity, CDOT, to generate the velocity error, 
XDOTE, that drives the amplifier (limiter). If the actual voltage, CDOT, is less than 
the theoretical one. XDOT, the limiter is set to + Vsat (+ 10 volts), that means, the 
system keeps applying "full power" to get to the desired position. The curve following 
process is illustrated in Figure 2.3 . When CDOT reaches XDOT the deceleration 
process starts and the limiter alternates -Vsat and + Vsat at its output in a bang bang 
process. The gain K2 is very large to guarantee the full acceleration. 
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Figure 2.1 The Proposed System. 
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Figure 2.2 The simple model. 

C. THE PLANT 

In this research two plants were tested, a disk driver and a robot motor. The 
transfer function of the disk driver was implemented first and in order to compare with 
the results obtained in [Ref. 1] the motor and load parameters were assumed to be the 
same, that is, the motor of a disk driver and a very small arm. As presented in Figure 
2.1 it is a second order system with a mechanical pole at 20.55 rad. sec , a pole at the 
origin and a gain equal to 13.3. 

D. THE IDENTIFICATION ALGORITHM 

The identification algorithm is represented in a separate block in Figure 2.1 
because it has a specific function and "connects" plant and model. However, it is a 
piece of software included in the microprocessor and imbedded in the program Model. 

The specific function of the algorithm is to measure the plant output and update 
the model parameters in such a way that the model approximates the plant the best it 
can. Since both model and plant have the same input, if they have identical transfer 
functions they will have the same behavior. This is what we need because the model is 
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perfectly controllable with position and velocity feedback. Thus, controlling the model, 
the plant will be controlled. 

In an ideal case the model will be exactly the same as the plant during the entire 
trajectory. This was the case when, as an experience to observe the behavior of the 
analog plant, it was set up as a double integrator and a gain, becoming a copy of the 
model. The results were fine and will be presented in detail in Chapter IV, where the 
plant hardware is discussed. 

As mentioned in Chapter 1 the algorithm used in this thesis was developed by 
Wikstrom in [Ref. 1] for a disk driver system whose transfer function is that of the 
plant studied in Chapter IV. Wikstrom considered two mandatory requirements to 
implement the autoadaptive algorithm: 

1. The calculations must be reasonable accurate to allow the model states to 
approximate the trajectory of the servo motor during the seek mode. The seek 
mode occurs in the full acceleration phase of the trajectory. 

2. The calculations must be simple to minimize the computation time. 
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In the algorithm, the gain Km. the model output CS and the model velocity 
CDOT are updated. In the ideal model if C is the position and Vsat the saturation 
voltage of the amplifier we can write: 

C = Km.V sat (t 2 ;2) - Km = 2C,V sat .t 2 

For a sampling interval equal to T. t = NT, where N is the number of sampling 
intervals that occured up to time t. Letting C = CS : 



Km = 



2CS 

v sat( NT > 



-> 



The velocity of the plant can be computed as 



CSDOT = 



CS-CS(N- 1) 
T 



Or, more accurately 



2[CS - CS(N - U] 

CSDOT = - — -CSDOT(N- 1) 
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III. SOFTWARE DESIGN - 16 BITS 



A. INTRODUCTION 

As pointed out in Chapter II. the model is just a double integrator with a 
constant gain Km. The controller is the servo system with position and velocity 
feedback and a velocity curve following. The block diagram of this system is depicted 
in Figure 2.1 . 

In order to simplify the task for the microprocessor the amplifier was assumed to 
be just a limiter without any linear region and the gain K2 that appears in Figure 2.1 is 
not needed anymore. The system will have a "bang-bang" control, that is. V will be 
+ 10 or -10 depending upon the value ofXDOTE. 

The software for this digital servo was designed following the natural sequence of 
the servo itself, from R to CM. In order to keep a uniform notation, equations, block 
diagrams, flowcharts and programs have the same name for the corresponding 
variables. The only difference is that in flowcharts and programs the dot above the 
letter, indicating derivative, is literally written. For instance, C or CDOT represent the 
derivative of C. Another point that must be clarified is that the output of the model is 
called CM in the assembly program, rather than C, to avoid confusion with the C 
register. Thus, the derivative of CM should be CM DOT but is called CDOT to simplify 
the notation. The flowcharts presented in this Chapter are directly related with the 16 
bit program "Model", presented in Appendix A. The instructions used in the program 
are based in (Ref. 2]. 

B. MAIN PROGRAM 

The two first blocks of Figure 3.1 initialize the parallel port and some variables . 
The parallel port organizes the traffic between the discrete and continuous world 
involved in this research. The function of each port will be explained in detail in 
Chapter IV where the hardware is presented. The variables used in the main program 
are discussed in the following paragraphs. 

The step input, R. is the position to be achieved by the robot arm. Its value can 
be entered from the keyboard and is requested by the program. The maximum value 
allowed is 127, limited by the eight bit A D converter. CM is the output of the model 
and represents its actual position. CM 1 is the position at time t minus one. that is. the 
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Figure 3.1 The Main Program - Flowchart A. 
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previous value of CM. The actual velocity of the model is CDOT. This velocity is 
fedback to be compared with XDOT as shown in Figure 2.1 . CDM 1 is the model 
velocity at time t minus one or the last value of CDOT. CDDOT is the actual 
acceleration of the model. CDDM1 is the previous value of the acceleration. 

The output of the plant is called CS and represents the actual position of the 
robot arm. CMCF represents the product between CM and CF, where CF is a 
correction factor used to raise the value of CM before integration. This will be 
explained later in this Chapter. XDOT is the velocity computed on the basis of the 
deceleration curve of the motor, as mentioned in Chapter II. XDOTE is the dilTerence 
between the desired and actual velocity of the model. KM is the motor gain. X is a 
temporary memory for the index register IY. This register points to the next position of 
the memory available for data storage and its value is copied into the memory location 
N in order to check the end of memory. The memory available to store data goes from 
1600H to 23FFH. So. the storage process must finish when the most significant byte 
of IY reaches 24H. NX counts the number of sampling intervals which have occured 
up to the present time and is used in the Wikstrom algorithm to compute the value of 
Km. 

During the development of the software, all important variables were presented 
on the screen on-line, using a routine called WRITE. This routine was called after an 
operation as. for instance, an addition, and displayed the result stored in the register 
pair ML. In this fashion, the following variables were monitored in each loop: Error, 
square root of error, XDOT. XDOTE. CDDOT. CDOT, CM and CS. They were 
presented on the screen in hexadecimal codes. The only problem with this routine is 
that more than 400 microseconds were required to display one variable and this caused 
too much delay to the program .When the analog plant is part of the system we cannot 
afford such delays since the continuous system does not stop working. The alternative 
solution is to display the partial results off-line using the routine DISPLAY. But. 
before using this routine, the data must be stored in the memory. Thus, the routine 
WRITE was replaced by the routine STORE. This routine takes the value of the 
variable stored in the register pair ML and stores it into the data memory (from 16001 1 
to 23FFIT). 

In some cases we do not need to store the variables in each consecutive loop but. 
for instance, store them each fifth loop. Thus, a flag must tell the STORE routine 
when a data is to be stored. This is the role of MFLAG. If MFLAG is zero the data is 



20 



stored and when it is different than zero no data is stored. NS is the variable which 
controls the number of loops that will not be displayed. When the memory is full the 
flag is disabled and no more data is stored. However, the program continues running 
normally. The operation scheme of MFLAG is shown in Figure 3.2 . At the beginning 
of the program MFLAG is initialized to zero. So, during the first loop the data is stored 
by routine STORE. At the end of the loop NS is incremented and checked. Since its 
value is not 5 yet, MFLAG becomes FFH and no data is stored in the next four loops. 
In the fifth loop NS is 5 and the flag is inverted, becoming zero again and the sixth 
loop has data storage. But NS is set to zero again and the process is repeated until the 
memory available for data storage is full. At this point the flag is converted to 55H and 
from this point the inversion that occurs when NS is 5 does not convert the flag to 
zero anymore. That is, no more data is stored. 

The main program is structured with many subroutines. Some of them belong to 
the monitor and will be briefly discussed here. The monitor, whose program is 
presented in Appendix B. is the operational system that supervises the microcomputer. 
The remaining subroutines will be discussed in the next paragraphs. 

The subroutine STRING (monitor) receives characters from the keyboard and 
stores them in a stack . The subroutine HEXCONV (monitor) converts the data 
stored in the stack from ASCII to hexadecimal and stores them into the register pair 
DE. The subroutine SCRLF (monitor) provides carriage return and line feed. 

The subroutines SUBTRACT. ADDITION, MULTIPLY, DIVIDE and CURVE 
when performed store the result in the register pair HL. The operands must be in 
register pairs DE and HL before the subroutine is called. In the case of the subroutine 
CURVE (input is the position error and output is XDOT), the operand must be in HL. 
In the subroutine SUBTRACTION the operand stored in DE is subtracted from the 
operand stored in HL. In the subroutine DIVIDE the operand stored in HL is divided 
by the operand stored in DE. 

In order to be stored by subroutine STORE the data must be in register pair HL. 
This is very convenient since all operations send the result to these registers and all 
important variables come up from some operation. 

All variables and subroutines that appear in Figure 3.1 were discussed in the 
previous paragraphs. Summarizing the operation of these first blocks : 

1. The Parallel interface is set up 

2. Variables are initialized 
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Ficure 3.2 Data Stcrasc Control. 




3. Messages are sent to the screen introducing the svstem and asking for the angle 
input (R). 

4. GETSTRIN gets the characters from the keyboard. HEXCONY transforms 
them from ASCII to hexadecimal. 

The main program continues in the flowchart of Figure 3.3 . The value of the 
input position R is saved as an hexadecimal quantity. Between this block and the next 
is located the position feedback of the servo loop. The actual position is subtracted 
from the input position and the result is stored for future presentation (off-line). 
Register C is set as a flag to indicate if the position error is positive or negative. The 
error is tested. If it is negative, C is set to 1 and the number is converted to positive. If 
it is positive, no action is taken. XDOT is computed by subroutine CURVE and the 
result is stored into the register pair HL. 

The flowchart of Figure 3.4 starts with register C being tested. If it is zero, the 
error was positive and no action is taken. If it is different than zero, the error was 
negative and XDOT is converted to negative. In both cases, XDOT is stored for 
future presentation on the screen. The actual velocity. CDOT is subtracted from 
XDOT resulting XDOTE. which is stored. 

Continuing the description of the main program, the blocks of Figure 3.5 can be 
described in the following way. XDOTE, computed in the last operation is available in 
HL. Its value is checked. If it is positive, the variable V is set to + Vsat and if it is 
negative, V is set to -Vsat and the flag KM FLAG is set to 1. The value of V is the 
input of the model and also the input of the analog plant and must be sent to the 
digital to analog converter. The gain Km is multiplied by V and the result is stored. 

The product of V and Km just computed represents the acceleration (CDDOT) 
of the model and its integration yields the velocity . Before discussing the flowchart 
that shows this computation, let us explain briefly the trapezoidal integration used in 
this program. Mathematically we have CDOT = CDOT + ( CDDM1 + CDDOT ) 
T/2 , where the previous value of CDOT is added to the trapezoidal area formed by the 
actual and previous value of CDDOT and the time lapsed between them, as illustrated 
by the shaded area in Figure 3.6 . 

A very important point in the integration process is the integration step. T. It 
was- determined by simply replacing the instructions "JR PLUS" and "JR VOLTS" by 
"NOP" instructions. Thus, the ± 10 Volts are sent to the analog input and the time 
interval can be measured with an oscilloscope. It turned out to be 1.1 msec. 




Figure 3.3 The Main Program - Flowchart B. 
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In Figure 3.7 the flowchart of the trapezoidal integration of the acceleration is 
presented and can be described as follows: The acceleration CDDOT . just computed, 
is saved. The previous value of CDDOT is loaded into the register pair DE and the 
actual value of CDDOT is stored in CDDM1, that is. CDDMl is updated. The actual 
and previous value of the acceleration are added. The register pair DE receives T1 = 
2,'T. This transformation is necessary because T is a very small value and cannot be 
represented by a 16 bit integer number. So. instead of a multiplication by T 2, we can 
divide by 2 T = Tl. The sum, CDDOT + CDDMl. is divided by Tl. The last value 
of CDOT is added to the above result yielding: CDOT + ( CDDOT + CDDMl) T 2 
The actual value of CDOT is saved and stored for posterior presentation. This 
integration was first designed as a 16 bit computation and then modified to a 32 bit 
floating point program. The actual and previous value of the acceleration (CDDOT 
and CDDMl) are kept as 16 bit variables and the 32 bit value of CDOT is saved in 
temporary variables to be used in the next step. CDOT is also saved as a 16 bit 
number to be displayed on the screen. 

The conversions from integer to floating point and vice-versa are not detailed in 
the flowchart but each number that goes to the Arithmetic Processing Unit is 
converted to a 32 bit floating point number before the operation. 

The integration of CDOT just computed gives the actual value of the position, 
CM. However, there is a computational problem due to the fact that the integration 
step is very small. Since the first values of CDOT are also small and the computer is 
working with integer variables, all values of CM that are less than one are rounded to 
zero and not accumulated by the trapezoidal integration: 

CM = CM + (CDOT 4- CDM 1) T 2 

As can be seen from the above equation, as far as the second term (CDOT + 
CDM1)T 2 is zero (or rounded to zero) the value of CM will stay at zero. The way to 
bypass this problem was to magnify the value of the variable to be integrated (CDOT) 
multiplying it by an amplifier factor before the integration. After the integration the 
output is attenuated by the same factor. As shown in Figure 3.S the corrector factor 
(CF) was set up to 100 and the output of the integrating block is CMCF that stands 
for CM times CF. This was the first approach to compute CM and could be modified 
to work with 32 bit floating point numbers as in the CDOT computation. However. 
CM is being updated even. - loop and the result of this computation is not taken into 
account. If this is not the case, the integration instructions can be easily modified by 
looking at the CDOT computation. 




Figure 3.4 The Main Program Flowchart C. 
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With this introduction to the integration of the velocity the flowchart presented 
in Figure 3.9 is easily understood. This flowchart is a continuation of that studied in 
Figure 3.7 where CDOT was computed and loaded into the HL register. The last value 
of CDOT (CDM1) is loaded into the register pair DE and the actual value of CDOT 
updates CDM 1 for the next loop. CDOT (in HL) and CDM1 (in DE) are added. The 
register pair DE is loaded with TIOCF that stands for T1 over CF. This parameter is 
created by the fact that, as mentioned in the first integration. T1 = 2/T and the 
corrector factor multiplies the input variables. The division rather than multiplication 
was explained in the last (lowchart. The last value of CMCF is loaded into DE and 
added with (CDOT + CDM1)(T, 2)CF yielding the new value of CMCF. CMCF is 
saved, DE is loaded with CF and after the division the new value of CM is obtained, 
that is CM = CMCF CF. 

The main program continues in the flowcharts presented in Figures 3.10 and 3.11 
The idea behind this section of the program is to get the plant output and, using the 
Wikstrom algorithm, update the parameters of the model. Since these two flowcharts 
are at the end of the main program they also test the variables that control the end of 
the memory available for data storage and the frequency of storage . The flowcharts 
can be described as follows. CM, the actual model output just computed, is saved for 
future calculations and stored for off-line presentation. The subroutine ANALOG 
loads the plant output into the register pair HL and the subroutine STORE saves it at 
the data memory. The subroutine WALG applies the Wikstrom algorithm to update 
Km and CM based upon the actual and previous plant outputs. 

The variable NS. whose function is to control the frequency of storage, is 
incremented and checked. In the example presented in the flowchart the desired 
frequency of storage is 5. This means that the data are to be storage even.' five loops. 
As explained before during the discussion of the MFLAG scheme, if NS = 5 , MFLAG 
is complemented and becomes zero, enabling the storage process and NS is set to zero 
to restart the procedure. On the other hand, if NS is not zero MFLAG is set to FFH, 
disabling the storage process. The data memory is cheeked. If it is full MFLAG is set 
to 55H and from this point no more data is stored, since the complement of 55H is 
AAH and MFLAG will never be zero again. If the memory is not full, no action is 
taken. In both cases the program is addressed to the beginning to close the loop. 
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Figure 3.5 The Main Program -Flowchart D. 
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Figure 3.6 Trapezoidal integration. 



C. SUBROUTINES 

The main program "MODEL" was structured to be easily understood and 
followed. Since it is written in Assembly language some simple operations need lots of 
instructions. In order to overcome this problem, all repetitive operations were 
implemented in subroutines. 

Each time a subroutine is invoked, 13.5 microseconds are added to the program: 
S.5 due to the instruction "CALL" and 5 microseconds due to the instruction "RET". 
In the present program there are 3S calls to subroutines yielding a total time of 513 
microseconds. This reasonable "delay" is not affecting this experiment but could affect 
a practical application. However, if necessary, this time can be reduced to zero by just 
imbedding all the subroutines into the main program. 



29 




Figure 3.7 The Main Program - Flowchart E. 



30 




Figure 3.S Velocity Integration using the Corrector Factor. 

I. The Subroutine ANALOG 

The objective of this subroutine is to sample the plant output, CS, at the end 
of each loop. This is done through port B of the parallel interface and the analog to 
digital converter (ADC). Port B of the interface is at address 02H as determined at the 
beginning of the main program. 

Some of the instructions presented in this subroutine need a little knowledge 
of the hardware to be completely understood. However, the main idea can be absorbed 
from the flowchart presented in Figure 3.12 The blocks are now described in the 
sequence they appear in the flowchart. The ADC is enabled and starts converting the 
actual analog output to a corresponding eight bit number. The DATA READY pin of 
the ADC is polled and if data is available (conversion is completed), it is transferred to 
the A register. Otherwise the status is checked again. The incoming data is converted 
in a two's complement number by adding SOU. This is explained in detail in Chapter 
IV. 

After conversion in a two's complement number the data sign is checked. If it 
is negative a conversion to positive is executed. The reason to justify this procedure is 
quite simple. In this research the movement of the robot arm is restricted to just one 
direction and negative numbers are not expected. However, at the beginning of the 
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Fieure 3.9 The Main Program - Flowchart F. 



movement, when CS is still a very small number the noise can drive the output to a 
negative value and this would introduce an error in the system, since the program is 
not prepared to deal with negative numbers coming from the analog plant. Since the 
data is equal to or less than 127 and a positive number, it is loaded into register L and 
register H is set to zero. The ADC is disabled to allow the repetition of the process. 
This step will be detailed in Chapter IV. 

2. The Subroutines of Basic Operations 

The subroutines that perform addition, subtraction, multiplication and division 
will be called basic operations subroutines. They all use the Arithmetic Processing Unit 
(APU) Intel S231 to perform the operations. The procedure is the same for these 
subroutines as shown in Figure 3.13 . The operands are sent to the APU by subroutine 
OUTOP. Then the appropriate command (each operation has its particular code) tells 
the APU what operation is to be performed with those operands. Finally, the 
subroutine INOP (input operand) retrieves the result from the APU. In all talks 
between APU and microprocessor the operands and commands must pass through 
register A of the CPU. The APU operands and commands are addressed to outputs 
OSH and 09H, respectively. An important point to be noticed in the program is that 
the operands must be loaded in register pairs HL and DE before calling a basic 
operation subroutine. In order to get correct results in the subtraction and division 
subroutines we have to keep in mind that the registers will be manipulated in the 
following way: 

Subtraction is given by HL HL - DE 
Division is given by HL -« — HL/DE 

3. The Subroutines OUTOP and INOP 

As mentioned above the subroutines OUTOP and INOP communicate with 
the arithmetic processing unit in order to send operands before an operation and 
retrieve the result after the operation. The flowchart of the subroutine OUTOP is 
shown in Figure 3.14 . The contents of the registers HL and DE are sent to the APU in 
this order. Also notice that the low bytes are sent first in both cases. The subroutine 
INOP is presented in Figure 3.15 The result obtained in the APU after an operation is 
transfered to register A and then to registers II and L. in this order, one byte at a time. 
Notice that the high order byte of the sixteen bit result is the first to be retrieved. 
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4. The Subroutine CURVE 

This subroutine uses the APU to compute XDOT from the position error and 
the constant SQRT(2.V sat .Km). The computation is all done inside the processing unit 
to avoid the error caused by converting the square root to an integer. Ever} - variable or 
constant that is sent to the APU is converted to a 32 bit floating point number. After 
the computation XDOT is converted back to integer (refer to Figure 3.16 ). 

5. The Subroutine WALG 

This subroutine implements the autoadaptive algorithm described in [Ref. 1]. 
In that algorithm, the position, velocity and gain of the model are updated. However, 
the velocity CDOT is not being updated in this subroutine, for the following reason: 
the program was written for 16 bits but the interfaces were built to work with just eight 
bits, in order to simplify the plant. So. the biggest positive number the plant can deal 
with is 127 and the smallest is I. 

As a consequence of the above restrictions, the differences between an actual 
value of the plant output (CS) and its last value can not be always detected due to the 
round off problem. Since the computation of CDOT is based upon this difference, the 
result would be wrong most of the time. For instance, let's consider that the exact 
value of CS is 54. S2 and the last value of the plant output (CSM1) was 54.17. 
Assuming that the velocity is computed using the simple formula CSDOT = (CS- 
CSMlf'T and working with integers the result will be CSDOT = 0, since CS and CSM1 
were both rounded to 54. 

The flowchart of this subroutine is presented in Figure 3.17 and will be 
described in the following paragraphs. All the operations are done using the Arithmetic 
Processing Unit and integer numbers (16 bits). 

The variable KM FLAG is set to zero at the beginning of the main program 
and when the full acceleration phase ends, that is CDOT is greater than XDOT for the 
first time, it is set to 1. In the subroutine, the flag is checked and if it is one. KM is not 
computed anymore, remaining with its last value. 

In the full acceleration phase KM is computed and updated each time the 
subroutine is called. The formula used to compute KM is the following: 

KM = 2CS Vsat(XT) 2 . 

The values of Vsat and T are known and representing the constants by the parameter 
KMC we have: 

KMC = 2 lOVsat(T) 2 = 16529 for T = 1.1 ms and Vsat = 10. 
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The extra constant in the denominator (10) was introduced because the numbers 
cannot be greater than 32767. So, after the division by X (represented by XX' in the 
program) and the multiplication by CS. KMC must be multiplied by 10. This is shown 
in the eight blocks that follow the KM FLAG block ending with KM being updated. 
The reason KMC is not divided by XX" first (saving instructions) and then multiplied 
by CS and 10 is that when XX becomes a big number and KMC, XX" becomes less 
than one it is rounded to zero. So. after the first division (KMC, XX), there is a 
multiplication by CS to raise the result before dividing by XX again. 

6. The Subroutine STORE 

This subroutine transfers the data from register pair HL to the data memory. 
The purpose of this storage is to make those data available for an off-line presentation 
on the screen. As mentioned in the previous subroutines all operations send the result 
to the register pair HL. So, this routine is always called after some important 
operation. The flowchart is presented in Figure 3. IS and can be described as follows: 
The flag is checked and if it is zero the data is loaded into the memory and the pointer 
is incremented. Otherwise, no action is taken. 

7. The Subroutine DISPLAY 

The main purpose of this subroutine is the off-line presentation of the data 
stored by subroutine STORE on the screen off-line. That is, after the complete 
displacement of the robot arm, the program can be reset and the intermediate steps can 
be analyzed by calling the subroutine DISPLAY. The operation procedure is discussed 
in Appendix C. The variables that are set up to be stored by the actual program are: E, 
XDOT, XDOTE, CDDOT, CDOT, CM, CS and XX (the number of loops). They are 
stored from address 1600H to 23FFH, with a total of 35S4 bytes. Since each variable 
has 16 bits and eight variables are stored each loop, the memory is able to store 224 
loops of the main program. If the data are stored in consecutive loops, only the first 
246 milliseconds of data will be stored. If all the loops are not stored this time can be 
increased. For instance, if the data are stored every fifth loop the program will be 
documented for 1.23 sec. The number of loops to be stored can be changed if the 
program is transferred to the RAM (refer to Appendix C). 

Another important feature of this subroutine is the conversion from 
hexadecimal to decimal before displaying the numbers on the screen. This would be 
impossible to implement on line due to the amount of time required to implement this 
complex operation. The data is displayed in eight columns, ten rows at a time, and they 
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can be scrolled up by pressing the space bar or any other key. The number of rows to 
be presented at a time can be changed if the program is transfered to the RAM. 

The flowchart of the DISPLAY routine is presented in Figures 3.19a through 
3. 19e . The blocks can be described as follows, the memory pointer index IY is loaded 
with the first data address, 1600H. N is loaded with the number of rows (or loops) to 
be displayed (224) and N = 0 indicates the end of memory. NS controls the number of 
rows to be displayed at a time. After the initialization process the loop is started by 
loading the first data (the position error of the first loop) into the register pair HL. 
The data is checked. If it is positive a space is displayed on the screen and if it is 
negative a minus sign is displayed. The data is saved in a variable called NUMBER 
and the register pair DE is loaded with the decimal 10. The data (in HL) is divided by 
10 (in DE) and the quotient (in HL) is saved in the variable QUOT. 

The quotient (in HL) is multiplied by 10 (in DE). The result is transferred to 
DE and the data that was saved in NUMBER is loaded into HL. So. recalling that the 
subtraction does: 

HL = HL (previous) - DE 

and after this operation HL will be equal to the least significant bit of the decimal 
data. This value is saved in the variable ONES. Thus, 

ONES = dividend (data)- 10 QUOT 

The LONGDIV subroutine .presented in Figure 3.20 uses the same procedure 
mentioned above with the actual quotient being the dividend of the next division. The 
new reminder will be the second decimal digit (saved in the variable TENS). The 
process is repeated to get the next digits, saved in HUNDREDS, THOUS and 
TTHOUS. The biggest possible decimal number is 32767. 

The decimal digits are converted to ASCII and displayed on the screen using 
the monitor subroutine ASCONV (refer to Appendix C). After the presentation of the 
least significant digit, register B is loaded with the number two and the monitor 
subroutine SPACES is called to display two spaces between the number just shown and 
the next. 

Ever}’ time a conversion is completed the pointer is checked to verify if the 
row ended. At the end of the first row. for instance, the pointer (IY) will be 1610H. 
that is. the rightmost four digits arc zero. The same happens every time a row is 
completed since eight two byte variables make a complete row. Thus, if this situation is 
detected, meaning that a row is completed, the monitor subroutine SCRLF is called to 



36 



provide carriage return and line feed. Otherwise, a new data is converted. The loop 
continues until the end of the row. 

Whenever a row is completed the end of memory must be checked. As 
mentioned earlier the number of rows left is controlled by the variable N. So, each time 
a row is completed. X is decremented and checked. If it is zero the program is ended, 
otherwise it continues. 

The program is set up to present 10 rows at a time. The variable X'S counts 
the number of rows and while X’S is different of 10 the loop continues. When NS 
reaches 10 the program polls the keyboard input. While there is no input the program 
keeps polling the keyboard. When any key is typed, NS is set to zero and the loop 
continues. 

S. The Subroutine TRANSFER 

This subroutine is used to transfer the program MODEL from the EPROM to 
the RAM in order to debug the program. The starting address in the IN AM is 1000H. 
The procedure to use this feature will be discussed in Appendix C. The subroutine is 
very simple and can be understood from the program. 
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Figure 3.10 The Main Program - Flowchart G. 
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Figure 3.11 The Main Program - Flowchart H. 
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Figure 3.12 The subroutine Analog. 
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Figure 3.13 The Subroutine of Basic Operations. 
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Figure 3.14 The Subroutine Outop. 
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Figure 3.15 The Subroutine Inop. 
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Figure 3.16 The Subroutine Curve. 
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Figure 3.17 The Subroutine Walg. 
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Figure 3. IS The Subroutine Store. 
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Figure 3.19a The Subroutine Display. 
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Figure 3.19b The Subroutine Display. 
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Figure 3.19c The subroutine Display. 
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Figure 3.19d The subroutine Display. 
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Figure 3. 1 9e The subroutine Display. 
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Figure 3.20 The Subroutine LONGDIV. 
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IV. HARDWARE 



A. GENERAL 

The hardware consists basically of two major parts, the microprocessor and the 
analog plant. Interconnecting them we have the digital to analog and analog to digital 
interfaces. A video terminal is coupled to the microprocessor and all inputs and 
outputs are accessed by using this facility. An oscilloscope connected to the output of 
the plant measures the analog output. This voltage is also available in a digital form 
using (off-line) the routine Display. The whole hardware is mounted in three 
protoboards, one for the microprocessor, one for the analog plant and a third one for 
the extra memories used to store data. 

B. THE MICROPROCESSOR 

The microprocessor is a general term used to refer to the digital system that 
implements the model, controller and the identification algorithm. The circuit that 
shows all the digital system and interfaces is presented in Figure 4.1 . 

The central processing unit is the Z-80, the memories are two EPROMS (2716) 
and five RAM's (MK 4118). The memory and interface decoders are three 74LS138. 
The parallel interface is the M8255 and the serial interface is the MC68661. Besides 
the mentioned chips that are normally found in microprocessors there is the Arithmetic 
Processing Unit (A PUT), Intel 8231, that performs all the mathematical operations 
needed in the digital system. 

The organization of the memories is shown in Table 1 . The monitor and model 
(including the controller and algorithm) are loaded into the EPROM's. The RAM 
addresses from 1000H to 13A0H are used for scratch. This is an important point in the 
development of the system because it allows the whole program "Model" to be 
transfered from a non-crasable memory to an erasable one. Once the program is 
transfered it can be modified and run in the RAM using the monitor features for 
debugging purposes. This procedure will be detailed in Appendix C. 

The R\M addresses from 13A0H to 1600H are used to store the data segment, 
that is, all variables defined in the monitor and program Model. Also, every byte 
originated by typing a key in the keyboard goes to a particular stack in this memory 
area. The microprocessor stack pointer is initialized at 1600H. 
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TABLE 1 

MEMORY ORGANIZATION 



# 


START 


END 


TYPE 


FUNCTION 


Ml 


0000 


07FF 


EPROM 2716 


, 1 1 

monitor + model 


M2 


0800 


OFFF 


EPROM 2716 


model ( cont. ) 


M3 


1000 


13FF 


RAM MK4118 


scratch/data seg 


M4 


1400 


17FF 


RAM MK4118 


data seg/storage 


M5 


1800 


1BFF 


RAM MK4118 


data storage 


M6 


1COO 


1FFF 


RAM MK4118 


data storage 


M7 


2000 


23FF 


RAM MK4118 


data storage 



The memory from 1600H to 23FFH is the so called "data memory". It stores the 
intermediate results of program Model for future presentation on the screen. After a 
run the subroutine Display can be invoked to show these data. The RAM memories 
M4, Mo. M6 and M7 (refer to Figure 4.1). used for data storage, were created to allow 
the off-line display of the mentioned data. When the digital servo was first tested 
(without the analog plant) it used on-line routines to show the results on the screen. 
However, each time the routine was called to present one variable it spent more than 
400 microseconds. This would consist in a major problem for incorporating the analog 
plant. So. the extra memories were added to the system in order to provide room for 
the massive data record generated by the subroutine Store. 

As shown in the circuit, the decoder D1 addresses the EPROM's Ml and M2 and 
the RAM M7. The decoder D2 addresses the serial and parallel interfaces and the 
APU. Decoder D3 addresses the data memories M3, M4. M5 and M6. 

Decoder D2 is selected by addresses A2. A3 and A 4 and its outputs Y0 (pin 15). 
Y1 (pin 14) and Y2 (pin 13) are the chip select commands for the S255 (parallel port). 
6S661 (serial port) and APU, respectively. So, depending on the addresses A1 and AO. 
the parallel interface will be at addresses 00. 01, 02 and 03 and the serial interface will 
be at addresses 04. 05, 06 and 07. The APU will be at addresses OS. 09, 0A and 0B. 

C. THE ARITHMETIC PROCESSING UNIT 

This integrated circuit deserves a special attention in this research. First of all, it 
played a very important role on the software development in taking over all of the 
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mathematical operations. Secondly, it is a preliminary chip and its application consists 
in a parallel research. 

The Arithmetic Processing Unit (APU) S231, as referred in [Ref. 5] has the 
following features: 

1. Fixed point, single and double precision (16 32 bits). 

2. Floating point single precision (32 bits). 

3. Binary data formats. 

4. Add, subtract, multiply and divide. 

5. Trigonometric and inverse trigonometric functions. 

6. Square roots, logarithms, exponentiation. 

7. Float to fix and fix to float conversions. 

S. Stack, oriented operand storage. 

9. Direct memory access or programmed 1 O data transfer. 

10. General purpose 8 bits data bus interface. 

In the 16 bit program this chip is used to perform the following operations: 
addition, subtraction, multiplication, division, square root, fix to floating point 
conversion and vice versa. In general the operations were done with fixed point 
operands to keep the program working with 16 bit variables. However, some 
operations where the APU stack could be used as a temporary register, were done in 32 
bit floating point. This happened in the subroutine CURVE and in the trapezoidal 
integration in the main program. The advantage of this method is that the accuracy of 
the computations is increased without defining 32 bit variables. 

The 16 bit format is straight forward. It works with binary operands represented 
in two's complement values. The sign of the operand is located in the most significant 
bit (at the leftmost position). Positive values are represented by zero and negative 
values are represented by one. This format can represent numbers in the range from 
- 3276S to 32767. 

The 32 bit floating point format permits us to represent positive and negative 
numbers from 2.7 x 10'“^ to 9.2 x 10^ and zero. As depicted in Figure 4.2, the 32 
bit numbers consist of four parts: mantissa, exponent, exponent signal and mantissa 
signal. The mantissa uses the 24 rightmost bits (0-231. the exponent uses the next six 
bits (24-29). the exponent sign uses the next bit (bit 30) and the mantissa sign is 
represented at the leftmost bit (bit 31). 



56 



exponent 



mantissa 



3130 



2 4 2 3 



0 



Figure 4.2 32 Bit Floating Point Register. 

A requirement of this processor is that the data, when using 32 bit floating point 
format, be represented by a fractional mantissa value between 0.5 and 1.0 multiplied by 
two raised to an appropriate power, that is. value = mantissa x 2 ex P onent . 

Illustrating the explanation above with an example, let's take the number 624 
and convert it to 32 bit floating point: 

624 = 512 + 64 + 32 + 16 = 2 9 + 2 6 4- 2 5 + 2 4 = 

= 0.1 x 2 10 + 0.0001 x 2 10 + 0.00001 x 2 10 + 0.000001 x 2 10 = 

= 2 10 x (0.100111) 

The binary representation of the above example is shown in Figure 4.3 . The 
hexadecimal representation of this four byte number is 0A9C0000H. This is the code 
to be sent to the APL' in order to create the floating point equivalent to the decimal 
624. 

The APL’ uses a stack to store the operands and results. It is an eight level 16 bit 
wide data stack, as shown in Figure 4.4 . The same stack is used to deal with 32 bits 
but, in this case, the configuration changes to a four level stack. The upper level is 
called TOS (top of stack) and the level below the TOS is called NOS (next on stack). 

Data are written onto the stack, eight bits at a time in the order Al. A2. A3, etc. 
and are removed in the reverse order. For instance, suppose the operation B — A = C, 
where B = B2 Bl. A = A2 Al and C = C2 Cl. In a subtraction the operand in the 
TOS is subtracted from the operand in the NOS and the result is stored onto the TOS. 
Thus, the bytes must be sent in the following order: Bl, B2, Al. A2. The result is 
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Figure 4.3 Example of a 32 Bit Floating Point Number. 




Figure 4.4 Stack Configuration for A PL" S231. 

retrieved in the order C2, Cl. Considering the way the software was designed, the 
operand B would be onto the register pair HL and the operand A onto the register pair 
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DE. The result would be in HL. So, the data from the registers would be sent to the 
APU in the following order: L. H. E. D and the result would be received in the order 
H, L. 

The data entry and data removal process is illustrated in Table 2 . Data entry is 
accomplished by bringing the chip select (CS). the command, data line (AO) and the 
write line (WR) low. A new entry occupies the TOS, pushing the previous TOS to 
NOS. Data removal is performed by setting CS. AO and RD low. The data in TOS is 
removed and the data in NOS is moved to TOS. 

TABLE 2 

DATA ENTRY AND DATA REMOVAL PROCESS 



WR 


RD 


CS 


AO 


OPERATION 


INSTRUCTION 


1 


0 


0 


0 


Read 


IN 


A, ( 08H) 


o 


1 


0 


0 


Write 


OUT 


( 08H) , A 


0 


! i 


0 j 


1 1 


Command 


OUT 


( 09H) , A 


1 1 


1 0 


0 


1 


Read Status 


IN 


A, ( 09H) i 



After the data have been entered the required operation can be performed by 
issuing a command. The command operation is accomplished by bringing the chip 
select line low, command, data line high and write line low. 

It can be seen in Figure 4.1 that the READY line of the APU (pin 17) is 
connected to the WAIT line of the CPU (Z-SO). The READY line is normally high and 
is pulled low by the APU when certain conditions occur. Basically, the READY line 
goes low when the APU is busy and either data or command operation is requested. If 
this happens, the WAIT line of the CPU goes low and it waits. When the operation is 
completed the READY line goes high and the result is available at the TOS. Then the 
CPU can retrieve the data from the APU. The process of removing data is illustrated in 
the first row of Table 2 . 

The software for the the APU is quite simple and can be easily understood from 
the. program. However, in order to figure out how the operations work and to have a 
complete knowledge of the chip, some small routines were written to test individual 
operations. These routines were written in machine language using the features 
available in the monitor. 
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As pointed out earlier in this Chapter, the memory addresses from 13A0H to 
1600H are used for the data segment, that is. to store the variables used in the 
program. But this section of memory is not completely filled and there is some space 
available. The test program can start at address 15A0H. for instance. The sequence to 
write the program is the following: 

1. Turn on the system (video terminals and power supplies). 

2. Reset the system by pressing the reset switch. 

3. In the keyboard, type: CloAO.xxxx <rct>.. This will be the segment of 
memory to' be used (xxxx is the end address of the small program). 

4. Type in the machine language program, entering one bvte at a time, that is. 
type two hexadecimal numbers and hit the return Key. 

The procedure to run the routines and get the results is as follows: 

1. Type G15A0.WW <ret>. where wvy is the end address plus one of the 
routine, that is.'yyyy is equal to xxxx -f ’ 1. 

2. When the execution is completed the registers will be automatically displaved 
on the screen and the result of the operation under test will be shown in the 
register HL. 

1. Subtraction Routine 

The APU performs NOS - TOS and stores the result onto the TOS. The 
result is removed from the TOS and stored into the register pair ML. where it can be 
checked after the execution of the routine. In the example shown in Table 3 the 
operands are 0002 (TOS) and 0007 (NOS). So. the expected result is 0005. Other 
examples can be done by just changing the operands. In this particular example the 
last address is 15B9H and the execution command should be: G15A0.15BA < ret> . 
With this command the program will run and the CPU registers will be displayed on 
the screen. 

2. Multiply Routine 

The APU performs NOS x TOS and stores the result onto the TOS. The 
result is removed from TOS and stored in HL where it can be checked after the 
execution. The routine is presented in Table 4 using the operands: FFFAH = - 6 and 
0001H = 1. Thus, the expected result is FFFAH = — 6 . Other operands were used 
to check the routine: FFFAH = - 6 as first and second operand with result 0024H = 
36 and FFFAH = -6 and 0002H = 2 with result FFF4H = - 12. 

3. Square Root Routine 

This routine is performed using 32 bit (floating point) format. Therefore, the 
16 bit integer operands must be converted to floating point and the result, converted 
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TABLE 3 

SUBTRACTION ROUTINE FOR TESTING THE APU 



Assembly 

Language 


Address 


Machine 

Language 


Comments 


LD 


A, 07H 


15AO 


3E07 


APU <- 


- first operand 


OUT 


( 08H ) , A 


15A2 


D308 


: 


LD 


A, OOH 


15A4 


3E00 




OUT 


( 08H ) , A 


15A6 


D308 


1 


LD 


A, 02H 


15A8 


3E02 


APU <- 


- second operand 


OUT 


( 08H) , A 


15AA 


D308 




LD 


A, OOH 


15AC 


3E00 




OUT 


( OSH) , A 


15AE 


D308 




LD 


A, 6DH 


15B0 


3E6D 


APU <- 


- subtraction 


OUT 


( 09H) , A 


15B2 


D309 




IN 


A, ( 08H ) 


15B4 


DB08 


1 

1 

V 


result 


LD 


H, A 


15B6 


67 




IN 


A, ( 08H) 


15B7 


DB08 




LD 


L, A 


15B9 


6F 





back to integer. In the example shown in Table 5 the operand is 0270H = 624 and the 
expected result is 1SH = 24. that is. the square root is rounded off to the next less 
integer. As in the previous routines the result can be checked at the HL register after 
execution. Since the start address is 15A0H and the end address is 15B9H, the 
execution command will be : G15A0.15BA < ret> . 

D. THE INTERFACES 

The serial and parallel interfaces, MC6S661 and MS255, respectively, are largely 
used with eight bit microprocessors and will have just a short explanation. The serial 
interface interchanges information with the video terminal. So, all the commands 
corning from the terminal keyboard and all information going to the screen are 
formatted by this chip. The parallel interface connects the microprocessor with the 
analog plant. So. the plant input (V) and the plant output (CS) pass through this 
interface, in digital format. As shown in Figure 4.1 the three ports available in the 
8255 are used in the following way: 
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TABLE 4 

MULTIPLICATION ROUTINE FOR TESTING THE APU 



Assembly 

Language 


Address 


1 

Machine , 
Language 


Comments 


LD 


A, FAR 


15A0 


3EFA 


APU<--f irst 


operand 


OUT 


o 

0o 

i~M 

> 


15A2 


D308 




LD 


A, FFH 


15A4 


3EFF 




OUT 


( 08H ) , A 


15 AS 


D308 


: 


| LD 


A, OIK 


15A8 


3E01 


A?U<-- second 


. operand | 


OUT 


( 08H) , A 


15AA 


D308 




j LD 


A, 00H 


15 AC 


3E00 




OUT 


( 03K ) , A 


15AE 


D308 




LD 


A, 6EH 


15B0 


3E6E 


APU<--mult. 


command 


OUT 


( 09H ) , A 


15B2 


D309 


I 


IN 


A, ( 08K ) 


1534 


DB08 


i HL<--result 


from APU j 


LD 


K, A 


15B5 


67 




IN 


A, ( 08H) 


15B7 


DB08 




LD 


L, A 


15B9 


6F 





1. Port A provides the digital output (V) to the digital to analog converter (DAC 

0S00) ~ 

2. Port B receives digital input (CS) from the analog to digital converter (AD570) 

3. Port C is used to control the AD converter 

The digital to analog converter (refer to Figure 4.5) is always converting the 
digital input to a continuous voltage output between pins 2 and 4. The reference 
voltages, applied at pins 14 and 15 are +5 V and —5 V, respectively. The resistors 
connected to these terminals are called reference resistors. 

The full scale output current (If s ). represented by the sum of the currents at pins 
2 and 4 , is related to the reference voltages and resistors in the following way: 

T fs = ( + v W R ref' ) x (255 256 ) 
f fs *0 + 

V rcf = + 5 - ( - 5) = 10 V -> Ip s ~ 2 mA 
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TABLE 5 

SQUARE ROOT ROUTINE FOR TESTING THE APU 



Assembly 

Language 


Address 


Machine 

Language 


Comments 


LD 


A, 7 OH 


15A0 


3E70 


APU <-- operand 


OUT 


( 08H ) , A 


15A2 


D308 


1 


LD 


A, 02H 


15A4 


3E02 




OUT 


( OSH) , A 


15A6 


D308 




LD 


A, 1DH 


15A8 


3E1D 


! int. /float command! 


OUT 


( 09H ) , A 


15AA 


D309 


j 


LD 


A, OlH 


15 AC 


3E01 


sq. root command 


OUT 


( 09H) , A 


15AE 


D309 




LD 


A, 1FH 


15BO 


3F 


float/int. command 


OUT 


( 09H) , A 


15B2 


D309 




IN 


A, ( 08H) 


1534 


DB08 


HL <-- result 


LD 


H, A 


1536 


| 67 


| | 


IN 


A, ( 08H) 


1537 


DB08 




LD 


L, A 


1539 


6F 





In full scale, that is. with all digital inputs equal to 1, the current Iq is 2 mA and 
the current Iq is 0. So, to get + 5 V at the operational amplifier output, R2 must be 2.5 
KF2 . In zero scale, that is, with all TTL inputs equal to 0. Iq = 0 and Iq = 2 mA. 
Thus, to obtain -5 V at the output R1 must also be 2.5 KF2 . In the actual design, 
the plant is being driven by an input of ± 10 Volts and the resistors are both 5KH . 

In the ADC, located at the plant output, the input can vary from — 5 V to +5 
V, providing digital outputs from 00H to FFH. respectively. This is not compatible 
with the two's complement format of the microprocessor, where 0011 corresponds to 0 
and FFH corresponds to — 1. In order to correct this discrepancy, even.’ time a 
number comes from the ADC, the program adds SOIL The effect of this correction is 
illustrated in Table 6 . Looking at the Table one can see that a difference of 1 inside 
the microprocessor corresponds to a difference of 0.039 volts in the analog plant (5 
volts' 2^ because we are dealing with eight bit numbers. There is a difference of S0H 
between the second and third columns, that is, between the binary numbers at the 
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TTL INPUTS 



R2 

"VWV 



Vref Rref 




9 — 'VvV 


14 


^5v 5K 


*”3 




DAC- 08 00 




15 7 


- 5v 5K 






Figure 4.5 Digital to Analog Converter. 

interfaces and the two's complement numbers inside the microprocessor. This is the 
reason why the software adds SOH when a number is received from the ADC (refer to 
subroutine Analog in Chapter III). 

In the case of the "bang-bang" input of the plant ( = 10 Volts) the software sends 
00 H or FFII directly to the DAC and there is no problem with conversions. 

Tite analog to digital converter, AD570, receives the analog output of the plant 
(CS) and convert it to an eight bit number. As shown in Figure 4.1 the output of the 
ADC is connected with port B (pins IS through 25) of the parallel interface MS255. 
Port C of S255 (pins 10 and 17) is used to control the sampling process. When the 
BLANK and CONVERT input (pin 17) of the ADC goes low the conversion is started. 
Upon completion of the conversion the DATA READY terminal (pin 1 1) goes low and 
the data is available at the output. The BLANK and CONVERT input must become 
high again to prepare the device for the next conversion. Thus, the software has to 
control these two lines to get the data at the appropriate time. 

Table 6 can be used to relate the data inside of the micro and at the ADC 
output. The two converters must be adjusted to have the same correspondence between 
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TABLE 6 

NUMBERS INSIDE AND OUTSIDE THE MICROPROCESSOR 



Analog 


ADC 


I 

Inside Micro (2's compl. ) 


( volts ) 


Binary 


Binary 


Hex 


Decimal 


+ 4. 96 


iiiiim 


01111111 


7F 


+ 127 

..... j 


+ 0. 39 


10001010 


00001010 


OA 


+ 10 


+0. 039 


100000C1 


00000001 


01 


+ 1 

. .... ..... | 


0 


10000000 


00000000 


00 


0 


-0.039 


01111111 


11111111 


FF 


-1 i 


-4. 61 


00001010 


10001010 


8A 


-118 


-5 


00000000 


10000000 


80 


-128 



the numbers since the whole system must be compatible. In order to guarantee that 
DAC and ADC are tuned, some simple tests were done. One test consists in applying a 
DC voltage at the ADC input and send this voltage to the DAC output using a small 
program. This program is written in machine language and can be loaded into the 
RAM, using the monitor. An example is presented in Table 7 . The voltage measured 
at the analog output (V) must be the same as that applied at the analog input (CS), if 
the resistors in the operational amplifier are equal to 2.5KH . This voltage can be 
varied and observed at the plant input (V). 

The small program is executed with the command G15B0.FFFF < ret> . This 
command guarantees that the last address is included and the program will be in loop. 
The second address in the command could be anyone greater than 15C9. Some lines of 
this routine need more explanation: 

1. Lines 1 and 2 set uc the S255 to transmit data through ports A and C and 
receive data in port B. In other words, ports A and C are outputs and port B is 
input. 

2. In lines^3 and 4 a zero is sent to port C (PC7 or pin 17). in order to drive the 
BLANK CONVERT control of the ADC to low. enabling the conversion. 

3. In line 5 the DATA READY pin is checked to verifv if the data is alreadv 
converted. If it is not. the polling process continues in the loop described in 
lines 5,6 and 7. 

4. In line S the data is retrieved from port B and in line 9 they are sent to port A. 
where the DAC is connected. 

5. In line 11. port C receives SOH. That means, pin PC7 receives 0. disabling the 
conversion and preparing the ADC lor the next one. 
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TABLE 7 

COMPATIBILITY TEST BETWEEN ADC AND DAC 



# 


Assembly 

Language 


Comments 


Address 


i 

Mach. 
Lang. | 


1 




LD 


A, 83 


control word 


15B0 


3E83 


2 




OUT 


( 03H ) , A 


8255<--c. word 


15B2 


D303 


3 


LOOP: 


LD 


A, OOH 


A< - - OOH 


15B4 


3E00 


■4 




OUT 


( 02H) , A 


start conversion 


15B6 


D302 


1 5 


WAIT: 


IN 


A, ( 02H ) 1 


A< - -DATA READY 


1538 


DB02 


6 




CP 


0 


IS DATA READY? 


15BA 


EEOO 


7 




JP 


NZ, WAIT 


if notytry again 


15BC 


! C23815 

j 


8 




IN 


A, ( 01H ) 


A< - - data 


15BF 


DB01 


9 




OUT 


o 

o 

W 

> 


DAC<-- data 


15C1 


D300 


10 


1 


LD 


A, 80H 


A<-- 80H 


15C3 


3E80 


11 


r 


OUT 


( 02H ) , A 


disable ADC 


15C5 


1 D302 


12 


r 


J? 


LOOP 


repeat process 


15C7 


| C33415 



E. THE PLANT 

The plant is represented by an analog simulator as depicted in Figure 4.7 . The 
input of the plant is a "bang bang" control voltage. The output is a voltage that 
represents the robot arm position. CS. The input V comes from the DAC as discussed 
in the last section and can be + V or — V $at ( ± 10 Volts in our case). 

The design of the analog plant is straight forward and the method is found in 
most of the classical control books. The approach chosen is based in [Ref. 3]. As 
shown in Figure 4.6 the plant transfer function can separated in two blocks. 

Mathematically we have: 



X(s)_ 1 

U(s) s+ 20.55 



X(sXs+ 20.55)= U(s) 



sX(s) 4- 20.55X(s) = L'(s) — > x— 20.55.x = u. 
Then, x = u - 20.55x and v = 273.3] xdx 
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FROM 

MICROPROCESSOR 



TO 

MICROPROCESSOR 




Figure 4.6 Plant Transfer Function. 

The above equations provide all the information needed to implement the 
hardware. If x is assumed to be available (refer to Figure 4.7). the next step is to design 
an integrator to obtain x. Using a capacitor of lpF and a resistor of 1.MH the output 
of the integrator will be — x. The 10 Kf2 potenciometers that appear in all operational 
amplifiers are used for off-set adjustments. 

Since — x and V are available, a summer with a gain of 20.55 for — x and 1 for V 
yields ~x at the output. An inverter changes the sign of — x and the result is the x 
needed for the feedback to the starting point. The output y or CS is obtained from — x 
by integrating this variable with gain 273.3. 

The design of the plant was quite simple, but the implementation needed special 
attention. If the components are just put together without any care the result is 
catastrophic. Oscillations and drifts are the common problems. In the particular case of 
the integrators the critical points are the capacitor leakage and the input offset error. 
The integral of the DC offset voltage appears at the output like a ramp voltage, as 
explained in (Ref. 6]. The power supply can be a source of noise and each pin that is 
connected to a positive or negative voltage must have a capacitor to the ground. The 
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Figure 4.7 Analog Plant. 



6S 



material the capacitors are made of is a very important topic as pointed out by 
Roberge in [Ref. 4]. According to the specific application the capacitors must be: 

1. Teflon or polystirene for the feedback capacitors (integrators) 

2. Solid tantalum electrolvtic (areater than luF) for the positive and negative 
terminals of the power supply - ' 

3. Mica or glass (0.01 or 0. 1 JJ.F) for the power connections of each individual chip. 

The offset adjustments were done by connecting the inputs of the particular chip 

to the ground and adjusting the 10 KF2 potentiometer to obtain zero volts at the 
output. The inputs were grounded before the input resistors to guarantee that the drift 
voltage produced at the input due to these resistors were cancelled by the appropriate 
adjustment. In the case of the integrators, the capacitors must be discharged before 
the adjust. The switches in parallel with these capacitors (shown in Figure 4.7) are used 
for this purpose. They are also used to reset the integrators just before running the 
system. In this case, an analog switch, automatically commanded by the software 
should be desired and was designed. The recommended switch is the LF 11332. The 
supply could not provide this component. 

The plant was submitted to some tests to make sure the transfer function is being 
implemented. One of the tests consists in building a double integrator with an overall 
gain of 100. This particular implementation tests the integrator blocks in terms of 
drifting, oscillations and the integral operation itself. Each integrator has a gain of 10 
as shown in Figure 4.8 . 

The first integrator is driven by the square wave v(t) with a frequency of 100 Hz. 
The integration of the square wave results in an inverse triangular wave due to the 
minus sign of the integrator. Computing the output value of the first integrator at time 
t = 5 msec: 



1 ,T ,0.005 

x(t)= 5dt = - 10 5dt = -0.25 

RC J 0 J 0 



x(t) = - at. where a= 50 V sec or 0.05 V msec 



y(t)= 



1 r T 
— atdt 



RC J 0 




0.625 mV 
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Figure 4.S Double Integrator. 
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Once the double integrator is working well, a good test can be done to compare 
the performance of the digital model and the analog double integrator, since the model 
is also a double integrator with a gain (Km). So, if the gain Km is set to 100. both 
double integrators are supposed to have the same behavior. This is a very interesting 
test because the whole digital servo and interfaces are also checked. The test was 
carried out and the results displayed on the screen. In despite of the manual reset of 
the integrators the test was a success, that is, the values of CS (analog double 
integrator output) and CM (digital model output) were pretty close during all the time. 
The set up for this test is is shown in Figure 4.9 . The differences between this 
implementation and the whole system is that in this scheme the plant is just a double 
integrator and the model parameters are not being updated. 



Position Feedback 




Figure 4.9 Comparison between Digital and Analog Integrators. 

The entire analog plant can be tested and the results compared with the theory. 
Refering to Figure 4.6 one can see that the plant can be separated in two blocks. The 
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first block has input u and output x and the second block has input x and output y. 
These points are directly available in the circuit (refer to Figure 4.7). 

The second block can be tested in the same way used to test the double 
integrator. Applying a square wave at input x we obtain a triangular wave at output y. 
The theoretical results are presented in Figure 4.10 and can be obtained as follows: 

,T .0.005 

y(t) = - 273.3 jx(t)dt = - 273.3 j5dt = -6.S3V 



The test of the first block is not so trivial. The output is an exponential function 
for a step input as shown in Figure 4.11 . The Laplace transfer function of the block 
is: 



X(s) _ 1_ 

U(s) s + 20.55 



X(s) 



1 

s + 20.55 



U(s) 



Applying a step input of 10 V, U(s)= 10-'s, we obtain: 



10 10 1 1 

X(s) = = (— ) 

s(s^ 20.55) 20.55 s s+ 20.55 



Then, x(t) = (10,'20.55)[l(t)- exp( - 20.55t)] = 0.49[1 - exp( - 20.55t)] 



The theoretical results are presented in Figure 4. 11 . The input frequency was set 
to 1Hz to permit the total excursion of the exponential wave. It is important to 
sincronize the oscilloscope with the output to obtain a stable image on the screen. The 
results found in the practical experiment matched very well with those encountered in 
the theory. In all the tests the integrators are supposed to be reset right before the test. 

The gain of 273.3 can be splited between the last integrator and the adder to 
improve the performance of the analog computer. In this case the circuit presented in 
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273 . 3 


y 




s 







Figure 4.10 The Second Integrator. 

Figure 4.7 would have the 3K6 resistor replaced by a 36KF2 resistor in the last 
integrator (the gain will be 27.3) and the 200KF2 resistor at the adder replaced by a 
20KH resistor (the gain will be 10). 

Another good and easy test that can be done to verify the plant design is to 
apply a step input, say 1 Volt, and measure the output with a strip recorder. The 
equivalent plot can be done in the mainframe using the programs "Controls" or 
"Ewald" and the results can be compared. This test was carried out and the plots 
turned out to be very similar. 
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Figure 4.11 Testing the First Block of the Plant. 

The analog plant just discussed represents a motor of a disk driver. A second 
transfer function, representing a robot motor, was also implemented and tested. This 
transfer function was studied in [Ref. 7] and can be written as 

9.SS 

G(s) = 

sf — 1- 1)( — +• 1) 

9100 0.019 
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This transfer function has a real pole at —9100 that can be neglected and 
another real pole very close to the origin ( — 0.019) that can be approximated to zero. 
Therefore, for practical applications, the transfer function can be written as 



10 

G(s) = — - 
s - 



This plant was implemented in hardware by using two operational amplifiers in a 
very similar way as that showed in Figure 4.S . The only difference is that in the second 
integrator the resistor is 1 M£T. rather than 100 K£T . The gain of 10 is obtained in the 
first integrator to allow a direct test point for the velocity at the output of this stage. 
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V. PERFORMANCE OF THE SYSTEM 



A. THE SCALING PROBLEM 

As discussed in Chapter II, the input of the system is a commanded step that 
determines the position to be achieved by a robot arm or a disk driver arm. The actual 
position of the arm (CS) is represented in this research by the voltage at the analog 
plant output, which simulates the transfer function of the motor and load. So. this 
voltage is a parameter to be measured and converted to an angle in order to compare 
with the desired position and determine the performance of the system. 

Another requirement of the system is the curve following process, that is. the 
acceleration of the arm must be maximum until the velocity reaches the deceleration 
curve of the motor and from this point it must follow the curve. The velocity can be 
obtained from the analog plant by connecting an inverter at the input of the last 
integrator. 

At this point, it becomes necessary to explain the scaling problem between the 
analog and the digital world involved in this research. The plant input dimension is 
volts and the output dimension is radians. Therefore, one volt at the plant output 
represents an angle of one radian. Since the analog to digital converter is an eight bit 
interface driven by a 5 Volts source, 39 millivolts in the plant output is converted to l 
at the digital output of the ADC. This conversion and other examples are illustrated in 
Table 8 . 

Based on this table the input R applied to the system is a multiple of 2.23 
degrees. Also, the number that represents the gain constant, Km. in the program must 
take the scaling factor into account. Thus, for a Km equal to 300 radians per second 
we will have, in decimal representation: 

Km = 300 x 57.2 : 2.23 = 7708 

With the actual ADC the system can handle angles from 2.23 degrees to 2S4.2 
degrees. This resolution can be improved by increasing the number of bits in the 
interface. For instance, if a 12 bit interface is used and the reference voltage is kept the 
same (5 V). the minimum angle will be 0.14 degrees and the maximum will be 2S6.34 
degrees. 
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TABLE S 

THE SCALE PROBLEM 



ABC Input 


ADC Output 


CS( Volts) 


CS( radl ans ) 


CS( degrees ) 


Decimal 


Hexadec. 


0. 039 


0. 039 


2. 23 


1 


1 


0. 31 


0. 31 


17. 9 


8 


8 


0. 62 


0. 62 


35. 8 


16 


10 


1. 25 


1. 25 


71. 6 


32 


20 


2. 50 


2. 50 


142. 7 


64 


40 


3. 11 


3. 11 


179. 0 


80 


50 


4. 38 


4. 38 


250. 7 


112 


70 


4. 96 


4. 96 


284. 2 


127 


7F 



B. RESULTS 

As pointed out earlier, the system receives an input command from the keyboard 
and the analog output of the plant must respond as quickly as possible by using a 
curve following scheme for the velocity. In the case of this research, the performance of 
the system was checked by several means. 

During the development phase, while the system was not working as in its final 
version, the tests were done by using the routine Display, off-line (refer to Appendix 
C). After a run. all the important variables were presented on the screen and we could 
analyze what happened in every loop of the program. Also, the output of the analog 
plant was observed in the oscilloscope just to verify if the final position was reached or 
not. In this phase the velocity of the model was considered to be the same as the 
velocity of the plant. They are supposed to be similar if the algorithm works well. 

After the system started operating well under the verification tests mentioned 
above, a strip recorder was used to check the position and velocity of the plant. The 
position is readily available from the analog plant output and the velocity is obtained 
by taking the input of the last integrator ( - CSDOT 27.3) and driving it through a 
amplifier (and inverter) to get the actual velocity. 

The voltages obtained in both cases , position and velocity, are then converted to 
radians and radians per second, respectively. The tests were carried out for both plants 
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(disk driver motor and robot motor), using several inputs (R). The results are 
summarized in Figures 5.1 through 5.10 . In all plots the velocity of the strip recorder 
was fixed in 125 mm sec (maximum available). The plots are presented in the same 
scale they were obtained from the plotter. 

Looking at Figure 5.1 we can see that there is some overshoot in the position 
(CS) plot. In a real application the bang-bang control would be replaced by a linear 
compensator when the position is reached and this would prevent the overshoot or 
would reduce it to an acceptable value. In all the velocity plots it can be noticed that 
the full acceleration process occurs approximately over half of the trajectory. At the 
maximum point of the curve the actual velocity of the model (CDOT) or plant 
(CSDOT) crosses the curve of the desired velocity (XDOT). From this point, the 
deceleration curve of the motor is followed and the velocity drops following XDOT. 

In some cases the actual velocity (CSDOT) stays a little bit greater than XDOT 
and no "chattering" is observed as can be seen in Figures 5.1 and 5.2, for instance. In 
other cases CSDOT alternates being greater or less than XDOT and the "chattering" 
can be noticed as in Figures 5.4 and 5.5 , for instance. 

The commanded input in the keyboard is an hexadecimal quantity (last column 
of Table 8) and using the conversion presented in the Table we can label the plots in 
radians and radians per second. It is easily seen from the plots that the robot plant is 
much slower than the disk driver plant, as can be confirmed by comparing the abcissas 
(time) in the position plots and the ordinates in the velocity plots. 
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Figure 5.1 Position and Velocity for a Disk Driver Motor, R = 0.31 rad. 
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Figure 5.2 Position and Velocity for a Disk Driver Motor. R = 0.62 rad. 
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Figure 5.3 Position and Velocity for a Disk Driver Motor. R = 1.25 rad. 
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Figure 5.4 Position and Velocity for a Disk Driver Motor, R = 2.50 rad. 
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Figure 5.5 Position and Velocity for a Disk Driver Motor, R = 3.1 1 rad. 
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Figure 5.6 Position and Velocity for a Disk Driver Motor. R = 4.3S rad. 
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Figure 5.7 Position and Velocity for a Robot Motor, R = 0.62 rad. 
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Figure 5.S Position and Velocity for a Robot Motor. R = 1.2o rad. 
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Figure 5.9 Position and Velocity for a Robot Motor, R = 2.50 rad. 
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Figure 5.10 Position and Velocity for a Robot Motor, R = 3.11 rad. 
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VI. CONCLUSIONS / AREAS FOR FURTHER STUDIES 



The control of a robot arm or disk driver arm in minimum time (curve following) 
and autoadaptive was implemented using a microprocessor. The software was designed 
to work as a servo mechanism with curve following and to implement the algorithm 
that updates the model based on samples coming from the arm position. An analog 
computer simulated the motor and load of the arm. 

Two different transfer functions for the analog plant were tested, one for a disk 
driver motor and other for a robot motor. The first plant (disk driver) is found in 
[Ref. 1] and the second comes from [Ref. 7]. 

The initial goal of this research was to build a model to roughly represent the 
device (plant) to be actuated and by sampling its output to update the model in order 
to minimize the error between them (model and device). Once the model is a "copy" of 
the plant it can be controlled by using velocity feedback, position feedback and curve 
following in the model and then applying the same input to both plant and device. 

The actual algorithm that updates the output of the model and the "gain 
constant" Km. does not update the velocity. The technical reasons why the velocity is 
not being updated were explained in Chapter III, but the fact is that the lack of 
velocity updating did not influence the performance of the system at all since the 
velocity computed for the model is based upon the updated value of Km and in an 
indirect way, the velocity is being updated. 

The commanded input was applied from the keyboard in order to easily check 
the system for different inputs. However, as pointed out in Chapter I, this input can 
come from a central computer and. in this case, several systems like the one described 
here could be used to actuate different arms. 

The results presented in Chapter V show that the system works and can be used 
in a real application. It was also pointed out that it can be improved. One of the 
aspects that can be worked out is the interface. The system can go from a resolution 
of 2.23 degrees (eight bits) to a resolution of 0.14 degrees by just changing the interface 
(ADC) to a twelve bit ADC. For a sixteen bit ADC the resolution would go to 0.0087 
degrees. The problem here is that at this level the noise starts corrupting the results 
and additional arrangements (filters, isolations, etc.) must be incorporated. 
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Another improvement in the performance of the system would be to transform 
the whole program to a 32 bit program. The impact of this change would be in the 
accuracy of the system. The actual program does several operations using 32 bit 
floating point features of the Arithmetic Processing Unit as in the curve computation 
and in the trapezoidal integration. One concern about the use a 32 bit program is the 
time. However, a good measure to minimize the execution time is to cut off all the 
subroutine calls and imbed them into the main program. 

Another important topic for a future research is to connect the microprocessor 
with a real motor and arm and increase the resolution to 12 bits. Also, the movement 
of the arm coud have two stages: a large movement, using a resolution of 2.23 degrees 
(S bits) and a fine adjustment using a resolution of 0.14 degrees (12 bits). The S bit 
interface would allow a faster manipulation of the data during most of the trajectory. 

The basic idea and the skills necessary to implement a new hardware ; software 
or improve the one reported here were provided in this research. However, the best 
legacy of this thesis is the proof that, an autoadaptive algorithm applied in a real time 
programming for disk drivers and robots can be used succesfully. 
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APPENDIX A 

PROGRAM MODEL - 16 BITS 



. Z80 



EXTRN 


SCRLF , 


GETSTRIN,HEXCONV, 


GHEXERR , R ,CM ,CDOT ,CDDOT ,C0M1 , CD DM1 ,KM 


EXTRN 


N,V,CS 


,CSM1,CSM2, NUMBER 


, QUOT , ONES , TENS , HUNDREDS , THOUS , TTHOUS 


EXTRN 


RSSTAT 


,RECV, MESSAGE, MONITOR, HELLO, BOUT, TRAP3D, MONLOOP, SPACES 


EXTRN 


ECHO , ASCONV,TEMPIY >CMCF 


,CF,MFLAG,NN,KMFLAG,NS 


PUBLIC 


MODEL, 


TRANSFER, DISPLAY 




ZERO 


EQU 


0 




T1 


EQU 


D6BCH 


>INTEGRATION STEP (T1=2/TJ 


PVSAT 


EQU 


OAH 


^POSITIVE SATURATION LIMIT=+1D 


MVS AT 


EQU 


DFFF6H 


^NEGATIVE SATURATION LIMIT=-1D 


TIOCF 


EQU 


12H 


j T1/CF = 18 , T1=180D AND CF=10D 


KMC 


EQU 


381CH 


>KMC=CONSTANT IN THE ALGORITHM 


K1A 


EQU 


8CH 


>0.8*SQRT( 2.VSAT.KMJ 



> 

>THIS PROGRAM SIMULATES A SERVO SYSTEM. 

>THE VARIABLES HAVE THE FOLLOWING MEANING: 

',R STEP INPUT OR POSITION TO BE ACHIEVED BY THE OUTPUT 

>CM POSITION OUTPUT 

>CDOT VELOCITY 

jCDDOT . . . ACCELERATION 

>CDM1 PREVIOUS VALUE OF THE VELOCITY 

>CDDM1 . . . PREVIOUS VALUE OF THE ACCELERATION 



> 

> 

MODEL: 



LOOP: 

> 



CALL 


SCRLF 




LO 


A ,83H 


>PORT A IS OUTPUT TO D/A, 


OUT 


( 03H ) ,A 


> PORT B IS INPUT FROM A/D, PORT C 


LD 


A , 7FH 


jUPPER IS OUTPUT, LOWER IS INPUT 


OUT 


( 00H ) , A 


> RESET THE 0/A OUTPUT, XDOTE=D 


LD 


A,8DH 


> 


OUT 


( D2H ) , A 


^DISABLE A/O CONVERTER 


LD 


B , 1DH 


>THIS BLOCK RESETS THE VARIABLES 


LD 


HL ,CM 


jCM,CDOT ,CDDOT ,CDM1 ,CDDM1 ,CSM1 ,CSM2 


LD 


( HL ) ,ZERO 


J AND CMCF 


INC 


HL 




DJNZ 


LOOP 




LD 


HL,0D64H 




LO 


( CF J ,HL 


^CORRECTOR FACTOR< IDO 


LD 


A ,ODH 




LD 


\ MFLAG ) ,A 


> MODEL FLAG IS SET TO ZERO 


LD 


(NS ),A 


>NS( STORAGE CONTROL )<-— 0 


LD 


( KMFLAG J , A 


> ALGORITHM FLAG 


LD 


HL ,D5DDH 


5 KM= 256*5=1280 


LD 


( KM ) ,HL 


y 


LD 


HL ,DD01H 


jSET COUNTER TO ONE TO BE USED BY 


LO 


(NN),HL 


; WIKSTROM ALGORITHM 


LD 


HL ,DOH 


• HL< — - DOH 


LO 


( NUMBER ),HL 


j NUMBER < D 


LD 


( QUOT ) , HL 


\ QUOT < D 


CALL 


SCRLF 


> LINE FEED 


LD 


IX, HELLO 


>SET UP POINTER TO MESSAGE 


CALL 


MESSAGE 


} ASK FOR POSITION INPUT 


CALL 


SCRLF 




CALL 


GETSTRIN 


*,GET CHARACTER FROM KEYBOARD 


CALL 


HEXCONV 


^CONVERT INTO HEX 


JP 


C, GHEXERR 


y I F ERROR IN THE INPUT 


LO 


( R ) ? DE 


*,SAVE POSITION IN R 


CALL 


SCRLF 




LD 


IY , 16DDH 


>INIT . DISPLAY ROUTINE POINTER 
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PLOOP: 


LD 


DE,(CM) 


iDE< OUTPUT POSITION 




LD 


HL,( R) 


JHL< — INPUT POSITION 




CALL 


SUBTRACT 


5 POSITION ERROR=HL< HL-DE 




CALL 


STORE 


> SAVE POSITION ERROR 




LD 


C,0 


jSET FLAG TO ZERO FOR POS. NUMBERS 




BIT 


7 , H 


jIF NUMBER IS POSITIVE, 




JR 


Z, POSITIVE 


iGO TO LOCATION "POSITIVE" 




LD 


C,1 


ilF NUMBER IS NEG., SET FLAG TO 1 




LD 


A ,L 


5 CONVERT IT IN A POSITIVE NUMBER 




NEG 




>A<~ - 0-A (INVERTS THE A SIGN) 




LD 


L,A 






LD 


A ,H 






CPL 








LD 


H,A 




POSITIVE: 


CALL 


CURVE 


} HL< SORT ( ERROR )*K1*SQRT( 2KM. VSAT 




BIT 


0,C 


\ I F FLAG IS 0 , ( THE ERROR WAS POS.) 




JR 


Z,OK 


iGO TO "OK" 




LD 


A , L 


jTHE ERROR WAS NEGATIVE! SO, ... 




NEG 




jCONVERT IT BACK TO NEGATIVE 




LD 


L,A 






LD 


A,H 






CPL 








LD 


H , A 




OK: 


CALL 


STORE 


iSAVE XDOT 




LD 


DE , ( CDOT ) 


*DE< CDOT 




CALL 


SUBTRACT 


iXDOTEc— XDOT -CDOT 




CALL 


STORE 


)SAVE XDOTE 




BIT 


7 , H 


>IF XDOTE IS POSITIVE ... 




JR 


Z,PLUS 


*,GO TO PLUS 




LD 


HL , MVS AT 


• hl< 10 




LD 


A ,0DH 


j A< D 




OUT 


(D0H),A 


j DAC< ID VOLTS 




LD 


A,01H 


iSET KMFLAG TO 1 WHEN XDOTE< 0. 




LD 


( KMFLAG ) , A 


iKMFLAG <— A 




JR 


VOLTS 


iGO TO VOLTS 


PLUS: 


LD 


HL ,PVSAT 


jDAC< +10 




LD 


A , OFFH 


5 A< FF 




OUT 


( 00H) ,A 


iDAC< 10V 


VOLTS: 


LD 


( V),HL 


iV IS SAVED 




LD 


DE,(KM) 


• DEC-— KM 




CALL 


MULTIPLY 


i HL< CDDOT =KM*V 




CALL 


STORE 


iSTORE CDDOT (FOR DISPLAY PURPOSES) 




LD 


( CDDOT ) ,HL 


iSAVE NEW VALUE OF CDDOT 


i 

iTRAPEZOIDAL 


INTEGRATION 


: INPUT IS ACCELERATION, OUTPUT IS VELOCITY. 


iTHIS BLOCK 


DOES CDOT =CDM1+ ( CDDM1+CDDOT )*T/2 IN 32 BIT FLOATING POINT 


iTHE INTEGER 


IS COMPUTED 


TO BE DISPLAYED 


OFF LINE. 




LD 


DE , ( CDDM1 ) 


SDE<-— CDDM1 




LD 


( CDDM1 ) >HL 


iCDDMK CDDOT 




LD 


A , L 


i APU< CDDOT 




OUT 


( D8H ) > A 






LD 


A , H 






OUT 


( 08H ) , A 






LD 


A , 1DH 


i TOS( APU )< FLOAT( CDDOT) 




OUT 


( 09H ) , A 






LD 


A , E 


i APU< CDDM1 




OUT 


( OSH ),A 






LD 


A,D 






OUT 


( OSH ),A 






LD 


A , 1DH 


iTOS( APU )< FLOAT ( CDDM1 ) 




OUT 


( 09H ) , A 






LD 


A , 1DH 


jTOS< CDDOT +CDDM1 




OUT 


( D9H ) , A 






LD 


DE >T1 


*,DE< 2/T 




LD 


A , E 


i APU< T1 




OUT 


(08H),A 






LD 


A ,D 






OUT 


(OSH), A 






LD 


A , 1DH 


iTOS< FLOAT (Tl) 
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OUT 


( 09H),A 




LD 


A,13H 


*TOS< ( CDDOT +CDDM1 )T/2 


OUT 


(09H),A 




LD 


DE , ( QUOT ) 


iDE< LSBYTE OF CDOT (FLOATING) 


LD 


HL,( NUMBER) 


> HL< MSBYTE OF COOT (FLOATING) 


LD 


A >E 


;TOS< CDOT (FLOATING POINT) 


OUT 


( 08H ) , A 




LD 


A,D 




OUT 


(08H),A 




LD 


A,L 




OUT 


( 08H ) > A 




LD 


A,H 




OUT 


( 08H ) >A 




LD 


A,10H 


jTOS< CDOT + ( CDDOT +CDDM1 )T/2=CDOT 


OUT 


( 09H ) , A 




IN 


A,( Q8H ) 


j NUMBER ,QUOT < FLOAT ( CDOT ) 


LD 


H , A 




IN 


A , ( 08H ) 




LD 


L,A 




IN 


A , ( 08H ) 




LD 


D,A 




IN 


A, (OSH) 




LD 


E,A 




LD 


( NUMBER ),HL 




LD 


(QUOT),DE 




LD 


A,E 


^RETURN CDOT (FLOAT) TO APU 


OUT 


( 08H ) , A 




LD 


A,D 




OUT 


( 03H ) , A 




LD 


A,L 




OUT 


(OSH), A 




LD 


A ,H 




OUT 


( 08H ) , A 




LD 


A , 1FH 


*TOSo-- INTEGER(CDOT) 


OUT 


( 09H ) , A 




IN 


A > ( 08H 1 


jHL< INTEGER(CDOT) 


LD 


H,A 




IN 


A , ( 08H ) 




LD 


L,A 




LD 


(CDOT),HL 


iSAVE CDOT 


CALL 


STORE 


jCDOT IS STORED TO BE DISPLAYED 



^TRAPEZOIDAL INTEGRATION : INPUT IS VELOCITY 
*,THIS BLOCK DOES: CM=CMl+( CDMI+CDOT )*T/2 



LD 


DE , ( CDM1 ) 


j DE< CDMI 


LD 


(CDM1 ),HL 


jCDMl IS UPDATED (CDM1< CDOT) 


CALL 


ADDITION 


jHL< CDMI+CDOT 


LD 


DE,T10CF 


*DE< T1/CF=18 


CALL 


DIVIDE 


JHL< ( CDOT +CDM1 )/T 10F=CD0T*CF/T1 


LD 


DE , ( CMCF ) 


j DE< CMCF (CM *100 ) 


CALL 


ADDITION 


•,HL=CMCF=CMCF + ( CDMI+CDOT )*T/2 


LD 


( CMCF ) ,HL 


;CMCF IS UPDATED 


LD 


DE , ( CF ) 


J DE< CF 


CALL 


DIVIDE 


*HL< CMCF/CF = CM 


LD 


( CM ) , HL 


>CM IS UPDATED 


CALL 


STORE 


>SAVE CM (MODEL OUTPUT) 


CALL 


ANALOG 


. HL < CS FROM ANALOG PLANT 


CALL 


STORE 


jSTORE CS FOR DISPLAY PURPOSES 


CALL 


MALG 


•,KM AND CM ARE UPOATED 


LD 


HL,(NN) 


;HL< LOOP COUNTER 


CALL 


STORE 


STORE LOOP COUNTER 


INC 


HL 


^INCREMENT LOOP COUNTER 


LD 


(NN),HL 


)SAVE LOOP COUNTER 


LD 


A , ( NS ) 


} A< NS 


INC 


A 




LD 


(NS), A 


*,NS< NS + 1 


CP 


OlH 


ilS NS=1? 


JR 


Z, RESET 


jIF YES, GO TO RESET . 
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LD 


A , OFFH 


j A< FF 




LD 


( MFLAG ) , A 


jMFLAG< 11111111 




JR 


SCREEN 


SGO TO SCREEN 


RESET: 


LD 


A, (MFLAG) 


> A< MFLAG 




CPL 




•, COMPLEMENT THE FLAG 




LD 


(MFLAG), A 


SMFLAG IS COMPLEMENTED 




LD 


A ,0 


SA< 0 




LD 


(NS) , A 


SNS< 0 


SCREEN: 


LD 


(N),IY 


SN< IY 




LD 


A , ( N + l ) 


SA< — HIGH BYTE OF IY 




CP 


24H 


>IS IT 24? (MEMORY ENDS AT 23FFH ) 




JR 


NZ , CONTINUE 


*, IF IT IS NOT, GO TO CONTINUE 




LD 


A ,55H 


iSET MFLAG TO AVOID FURTHER STORAGES 




LD 


(MFLAG), A 


> SINCE THE MEMORIES ARE FULL. 


CONTINUE: 


JP 


PLOOP 


S END LESS LOOP 



J ************************************************************************************ 

******************** end of main program ************************************* 

s ***************************************************************************** 

s 

STHIS SUBROUTINE INPUTS THE ANALOG OUTPUT FROM THE PLANT ( CS ) 



ANALOG: 


LD 


A ,0 


SENABLE THE ADC CONVERTER 




OUT 


( 02H ) , A 


SPORTC< 00 


HOLD: 


IN 


A , ( 02H ) 


S A< READY LINE FROM A/D VIA P.C 




CP 


0 


SIS A/D READY? 




JR 


NZ,HOLD 


SlF NOT, VERIFY AGAIN. 




IN 


A , ( OIH ) 


sA< CS FROM PORT B 




ADD 


A ,SOH 


SCS IS CONVERTED TO 2‘S COMPLEMENT 




BIT 


7, A 


sCHECK OVERFLOW DUE TO NEGATIVE 




JR 


Z ,GOOD 


S VOLT AGE FROM A/D. IF THERE IS 




LD 


A ,0 


S OVERFLOW , A< 0 


GOOD: 


LD 


L , A 


sL< CS 




LD 


H , 0 


S H< 0 




LD 


( CS ) ,HL 


sSAVE CS 




LD 


A ,80H 


S A< CONTROL WORD TO DISABLE ADC 




OUT 


( 02H ) , A 


SPORT C< 80H 




RET 






> 

jTHIS SUBROUTINE IMPLEMENTS WIKSTRON 


ALGORITHM TO COMPUTE KM AND CDOT USING 


sTHE ANALOG OUTPUT FROM 


THE PLANT ( CS ) 


. THEN, CM, CDOT AND KM ARE UPDATED 


sKM=2CS/VSAT ( NT )**2 AND 


CDOT = ( CS-CSM1 )/T . OR, KM=( 16529/N**2 )*CS*10 , WHERE 


*, T = 1 . 1 MS 


AND VSAT = 10 






S 

WALG : 


LD 


A , ( KMFLAG ) 


SVERIFY FLAG. IF IT IS 1 DO NOT 




CP 


0 


SCOMPUTE KM ANYMORE. KEEP THE 




JR 


NZ, KMFIX 


SLAST VALUE. 




LD 


HL ,KMC 


SHL< KMC=2/VSAT*T**2*10 




LD 


DE , ( NN ) 


SDE< COUNTER 




CALL 


DIVIDE 


SHL< KMC/N 




LD 


DE , ( CS ) 


y DE< CS 




LD 


A ,E 


jA< CS 




CP 


0 


s 




JR 


Z, KMFIX 


SlF CS=0, KEEP INITIAL KM 




CALL 


MULTIPLY 


; H L< — — ( KMC/N )*CS 




LD 


DE , ( NN ) 


S DE< NN 




CALL 


DIVIDE 


SHL< ( KMC/N**2 )^CS 




LD 


DE , OAH 


sDE< 10 




CALL 


MULTIPLY 


jHL< (KMC/N**2)^CS^10=KM 




LD 


A,H 


S A< MSBYTE OF KM 




CP 


OCH 


SlF KM > 1072, SET KM TO OCCCH 




JP 


M, KMSMALL 


SELSE, GO TO KMSMALL 




LD 


DE , OCCCH 


S DE < OCCCH = 3276 




LD 


( KM ) ,DS 


>KM< 3276 




JR 


KMFIX 


S GO TO KMFIX (DO NOT GO TO KMSMALL 


KMSMALL : 


LD 


( KM ) ,HL 


SKM IS UPDATED 


KMFIX : 


LD 


HL , ( CS ) 


HL< CS 




LD 


(CM) ,HL 


S CM< CS, CM IS UPDATED 




CALL 


STORE 


sSTORE NEW VALUE OF CM 
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RET 



5 ADDITION ROUTINE USING THE INTEL APU 8231 : HL< HL+DE 



ADDITION: 


CALL 


CUTOP 


> SEND OPERANDS TO 8231 






LD 


A f 6CH 


> ADD COMMAND 








OUT 


( 09H )>A 










CALL 


INOP 


> GET RESULT AND STORE 


IN 


HL 




RET 










^SUBTRACTION 


ROUTINE US 


ING THE APU 


8231: HL< HL-DE 






j 

SUBTRACT: 


CALL 


OUTOP 


*SEND OPERANDS TO 8231 


STACK 




LD 


A ,6DH 


jSEND COMMAND SUBTRACT 


TO 


8231 




OUT 


(09H),A 










CALL 


INOP 


>GET THE RESULT FROM 8231 






RET 










y 

*, MULTIPLICATION ROUTINE 


USING THE 


APU 8231: HL< HL*DE 






> 

MULTIPLY: 


CALL 


OUTOP 


>SEND OPERANDS TO 8231 








LD 


A > 6EH 


iSEND COMMAND MULTIPLY 


TO 


8231 




OUT 


( 09K ) >A 










CALL 


INOP 


jGET THE RESULT AND STORE 


IN HL 



RET 



* 

\ THIS SUBROUTINE COMPUTES ( SQRT ( ERROR ) )*K1*SQRT( 2 . VSAT . KM ) USING 32 BITS 
} FLOATING POINT OPERATIONS OF THE ARITHMETIC PROCESSING UNIT (APU). 



CURVE : 


LD 


A , L 




>SEND DATA TO 8231 (16 BITS) 




OUT 


(08H),A 








LD 


A,H 








OUT 


( 08H ) , A 








LD 


A,1DH 




>SEND COMMAND TO CONVERT 16 BITS 




OUT 


( 09H ),A 




; INTEGER TO 32 BITS FLOATING POINT 




LD 


A,01H 




iSEND SQRT COMMAND 




OUT 


(09H )>A 




* 




LD 


DE,K1A 




• DEC— K1A=K1 . SQRT ( 2 . VSAT .KM ) 




LD 


A,E 




iAPU<-~ K1A 




OUT 


(08H),A 




y 




LD 


A >D 




\ 




OUT 


( 08H ) > A 




\ 




LD 


A > 1DH 




>TOS( APU )< FLOAT ( K1A ) 




OUT 


( 09H ) > A 




\ 




LD 


A,12H 




i MULTIPLY KIA^SQRT ( E ) 




OUT 


( 09H ) , A 




y 




LD 


A,1FH 




5 CONVERT THE RESULT TO 16 BITS 




OUT 


(09H),A 




y 




IN 


A > ( 08H ) 




j STORE THE RESULT IN HL 




LD 


H,A 








IN 


A,( 08H ) 








LD 


L > A 








RET 








) 

>THIS ROUTINE 


STORES 


INTERMEDIATE RESULTS 


TO BE DISPLAYED OFF LINE 


\ 

STORE : 


LD 


A,(MFLAG) 




* VERIFY MFLAG STATUS. 




CP 


0 




JIF IT IS 0, STORE DATA. 




JR 


NZ, NOSTOR 




J ELSE , DO NOT STORE. 




LD 


(IY),L 




jMEMORY< DATA (LOW) 




INC 


IY 




>IY IS INCREMENTED 




LD 


(IY),H 




}MEMORY< DATA (HIGH) 




INC 


IY 




y IY IS INCREMENTED 


NOSTOR: 


RET 








> 

> DIVISION ROUTINE US 


ING THE APU 8231: 


HL<- 


— HL/DE 


y 

DIVIDE : 


CALL 


OUTOP 


; OUTPUT OPERANDS TO 8231 STACK 




LD 


A > 6FH 


^EXECUTION COMMAND FOR DIVISION 




OUT 


( 09H ) ,A 


yIS 


SENT TO 8231 
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CALL 

RET 



INOP 



) INPUT THE RESULT FROM 8231 



> 

>THIS ROUTINE OUTPUTS OPERANDS TO 8231 STACK: NOS<---HL> TOS< DE 



> 



CUTOP: 


LD 


A >L 


>HL IS SENT TO 8231 STACK 




OUT 


( 08H ) > A 






LD 


A > H 






OUT 


( 08H ) > A 






LD 


A >E 


•>DE IS SENT TO 8231 STACK 




OUT 


(08H),A 






LD 


A,D 






OUT 


( 08H ) > A 






RET 






> 

jTHIS ROUTINE 


INPUTS THE RESULT FROM 


8231 APU: HL< TOS OF 8231 


> 

INOP: 


IN 


A,(08H) 


>HL< TOP OF STACK 




LD 


H > A 






IN 


A > ( 08H ) 






LD 


L > A 






RET 






J 

jTHIS ROUTINE 


CONVERTS 


THE DATA FROM 


HEXADECIMAL TO DECIMAL AND DISPLAY THEM. 


> 

DISPLAY: 


LD 


IY y 1600H 


>POINTER< 1400H (DATA LOCATION) 




LD 


A >0DFH 


>A< AMOUNT OF MEMORY AVAILABLE 




LD 


( N ) > A 


jSAVE THE INFO AT COUNTER N 




LD 


A,OOH 






LD 


(NS), A 


>NS< 0 


DLOOP : 


LD 


L,(IY) 


y L< DATA ( LOW) 




INC 


IY 






LD 


H , ( IY ) 


>H< DATA (HIGH) 




INC 


IY 






BIT 


7,H 


jCHECK MSB (IS THE NUMBER NEGATIVE' 




JR 


2, POS 


>IF IT IS POSITIVE, GO TO POS 




LD 


A ,H 


jIF NOT ,A< H( DATA-HIGH ) 




CPL 




} COMPLEMENT MSBYTE 




LD 


H , A 


$ PUT IT BACK TO H 




LD 


A,L 


S A< L (DATA-LOW) 




NEG 




. A < — - O-A ( 2 1 S COMPLEMENT) 




LD 


L,A 


>PUT IT BACK TO L 




LD 


A , 2DH 


>A< ASCII FOR - SIGN 




CALL 


ECHO 


^DISPLAYS - SIGN 




JR 


CONVERT 


SGO TO CONVERT 


POS: 


LD 


B,01H 


jB< OlH , TO PROVIDE ONE SPACE 




CALL 


SPACES 




CONVERT: 


LD 


(NUMBER ),HL 


*NUMBER< DATA TO BE CONVERTED 




LD 


DE,OAH 


• DEC— 10 (BASE FOR CONVERTION) 




CALL 


DIVIDE 


jHL< NUMBER/10 




LD 


( QUOT ) >HL 


jQUOTIENT< NUMBER/10 




CALL 


MULTIPLY 


jHL< QUOTIENT^IO 




EX 


DE,HL 


j DE< QUOT^IO 




LD 


HL,( NUMBER ) 


>HL< NUM3ER( DIVIDEND ) 




CALL 


SUBTRACT 


y HL< NUMBE R -QUOT* 10=RE MAI NDER 




LD 


( ONES ) >HL 


jOfiES< REMAINDER 




CALL 


LONGDIV 


>HL< NEXT REMAINDER (TENS) 




LD 


( TENS ) >HL 


>TENS<--- REMAINDER 




CALL 


LONGDIV 






LD 


( HUNDREDS )>l 


HL y HUNDREDS< REMAINDER 




CALL 


LONGDIV 






LD 


( THOUS ) >HL 


jTHOUSANDS< REMAINDER 




CALL 


LONGDIV 






LD 


( TTHOUS ) >HL 


*TENTHOUSANDS< REMAINDER 




LD 


A , ( TTHOUS ) 


j A< TTHOUS 




CALL 


ASCONV 


j CONVERT A TO ASCII AND DISPLAY 




LD 


A, (THOUS) 


jSAME THING WITH THE 5 DIGITS 




CALL 


ASCONV 






LD 


A, (HUNDREDS) 
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WAIT : 



END: 



CALL 


ASCONV 




LD 


A, (TENS) 




CALL 


ASCONV 




LD 


A, (ONES) 




CALL 


ASCCNV 




LD 


B > 02H 


$B< 0 2H TO PROVIDE 2 SPACES 


CALL 


SPACES 


>PUT TWO SPACES BETWEEN NUMBERS 


LD 


( TEMPIY ) >IY 


jSTORE POINTER 


LD 


A , ( TEMPIY ) 


. A < POINTER. LOW 


AND 


OFH 


jCHECK LSB OF THE POINTER 


CP 


0 


^COMPARE WITH ZERO. IF IT IS NOT 


JP 


NZ > DLOOP 


>0, THIS ROW IS NOT COMPLETED , REPEAT 


CALL 


SCRLF 


jIF IT IS, GO TO THE NEXT LINE 


LD 


A , ( N ) 


>A< COUNTER (MEMORY SPACE) 


DEC 


A 




LD 


( N ) , A 


>N< N-l 


CP 


0 


5 END OF MEMORY? 


JR 


Z ,END 


V I F YES, GO TO END. 


LD 


A , ( NS ) 


SA<— NS (DISPLAY CONTROL) 


INC 


A 




LD 


(NS ),A 


>NS< NS + 1 


CP 


OAH 


jIS NS=10 ?( IF 10 RUNS HAS ELAPSED) 


JP 


NZ, DLOOP 


>IF NOT, GO TO DLOOP 


IN 


A , ( RSSTAT ) 


* CHECK THE KEYBOARD INPUT. IF NO KEY 


AND 


2 


j WAS HIT, WAIT. 


JR 


Z , WAIT 


>ELSE, RESET AND REPEAT PROCESS 


IN 


A , ( RECV ) 




LD 


A , 0 


*A< 0 


LD 


(NS), A 


*SET NS TO ZERO AGAIN 


JP 

RET 


DLOOP 





jTHIS SUBROUTINE COMPUTES THE LONG DIVISION FOR THE SUBROUTINE DISPLAY 



LONGDIV: 



LD 


DE ,0AH 


jDE< BASE FOR CONVERSION 


LD 


HL , ( QUOT ) 


>HL< QUOTIENT 


LD 


( NUMBER ),HL 


*,SAVE NEXT DIVIDEND( LAST QUOTIENT 


CALL 


DIVIDE 


>HL< QUOT I ENT/10 


LD 


( QUOT ) ,HL 


JSAVE NEXT QUOTIENT 


CALL 


MULTIPLY 


$HL< QUOT*10 


EX 


DE ,HL 


jDE< QUOT*10 


LD 


HL,( NUMBER) 


>HL< — - NEW DIVIDEND 


CALL 

RET 


SUBTRACT 


*,HL< DIVIDEND-QUOT*10=REMAINDER 



$ 

>THIS BLOCK TRANSFERS THE ROUTINE MODEL FROM EPROM TO RAM, ADDRESS 0A00 



> 

TRANSFER: 



LD 


HL, MODEL 


>HL< SOURCE ADDRESS 


LD 


DE ,1000H 


• DEC— DESTINATION ADDRESS 


LD 


BC , 03A0H 


jBC< BLOCK SIZE 


LDIR 




TRANSFER, INCREMENT HL AND DE 
\ DECREMENT BC,IF IS NOT ZERO 
* REPEAT PROCESS. 


RET 






DS 


1 




END 
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APPENDIX B 
MONITOR 



1. MONITOR FEATURES 

The monitor is a program that provides all the software support for the 
microprocessor. It works as a supervisor of the system. When the reset switch is hit. 
the monitor takes over. The program counter is loaded with address zero and the 
monitor starts performing the initialization routines. The stack pointer is initialized, the 
serial port (video terminal communication) is set up and some messages are sent to the 
screen. After that the monitor (program "Main") waits for a command from the 
keyboard. 

The first message sent to the screen is a presentation of the system and the 
second one asks for a command (E. D or H). Taking the first choice, that is, typing"E". 
forces the program counter to be loaded with the program Model address and the 
program will be executed. If "D" is chosen, the results of the last run will be displayed 
on the screen (program counter is loaded with routine Display address) .If key H 
(Help) is typed, a list of features provided by the operational system is presented on the 
screen. All the possible utilizations of the monitor are included in the mentioned list. 
These features will be detailed in the next paragraphs. 

The "List" command permits us to list a portion of the memory. For instance, to 
look at the memory from addresses 1000H to 1 100H the appropriate command is: 
L1000,1100<ret> . 

The "change" command allows us to make changes in the memories (RAM). 
Thus, even small routines can be written in the spaces available. It is a powerful tool 
for debugging programs. For instance, to change data between addresses 15B0H and 
1513FH the command should be : C15B0.15BF < ret> . After this command the data 
contained at memory location 15 BOH will be displayed and the cursor will be at the 
first nibble of this data. To change the actual data, just type the new one. To skip this 
address, type return. 

The "Go" command permits us to run a program that is already in the RAM. 
Suppose a program was written in the example just mentioned between the addresses 
15B0H and 15BFH. The command to run this program is the following: 
G15B0.15C0 < ret> . Notice that the end address is one address above the last 
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instruction location. The program will run and the CPU registers will be displayed at 
the end. So, if the program has loaded some results into these registers, they will be 
available. Also, all the memories addresses can be checked by using the "List" 
command. The end address of the "Go" command is called "breakpoint" and can be 
any address inside the program. This allows a valuable debugging process of the 
program. 

The "Registers" command is used to look at the CPU registers (on the screen). 
The command is issued by typing : < R> . 

The "Transfer" command is used to transfer the program "Model" from the 
EPROM to the RAM (address 1000H). It is issued by typing <T> . Once the program 
is in the RAM it can be modified by using the "Change" command and can be 
debugged and executed by using the "Go" command. 

When the program "Model" is transfered to the RAM it can be executed by 
typing <M>. In order to run the program "Model" in the RAM it is necessary to 
change the address of the last instruction of the main program. This instruction is a 
jump to the beginning (JP PLOOP) of the program that is now at a different address 
(the original address is in the EPROM). So, we have to find out the new address of 
"PLOOP" in the RAM using the PRN file of program "Model" and then change the 
instruction "JP PLOOP". 

The "Display" command is a feature that permits the presentation of the 
variables of program "Model" on the screen after the execution of the program. The 
variables are stored in the data memory every' time the program is executed in the 
EPROM or RA M . This command is issued by typing <D>. The variables to be 
presented on the screen are : Error, XDOT. XDOTE. CDDOT, CM, CS and NN 
(number of loops). After the command the first ten rows are shown. To get the next 
ten rows, hit any key. 

2. MONITOR PROGRAMS 

In this section the programs that belong to the monitor are presented. They 
were developed during the EC-3800 course and modified a little bit to be used in this 
thesis. 
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.280 



EXTRN 


COMMANO 


,ERRMSG , MESSAGE , MONMSG ,SCRLF , TRAP30 ,TRANMSG ,BOUT ,TYPMSG 


PUBLIC 


BKPT >BS 


, BUFFIN, CHAR, 


CR, EADORESS, ESC , FALSE ,FLAG , FWDARW 


PUBLIC 


HEXBUF, 


LF ,MCNLOOP , OPCODE , RECV, RSSTAT ,RSTART30 


PUBLIC 


SPACE, SADDRESS, TEMP, 


TRUE, XMIT 


PUBLIC 


STAX, AFREG, BCREG 


,DER 


EG , HLREG , AFALT , BCALT , DEALT , HLALT 


PUBLIC 


PCREG, SPREG, IXREG, IYREG, V,CS, MFLAG, NN, KMFLAG, NS 


PUBLIC 


MONITOR 


,MODVAR , R 


>CM , 


COOT ,CDDOT ,CDM1 , C00M1 ,KM , COUNT ,CSM1 ,CSM2 ,N 


PUBLIC 


NUMBER, 


QUOT, ONES 


, TENS, HUNOREDS,THOUS, TTHOUS, TEMPIY, CMCF, CF 




DSEG 








BKPT : 


OS 


2 


^BREAKPOINT AOORESS 


BUFFIN: 


OS 


OFFH 


5 INPUT BUFFER 


CHAR: 


OS 


1 


jSTORE CRT CHARACTER HERE 


EADORESS: 


OS 


2 


>ENO 


AOORESS BUFFER 


FLAG: 


OS 


1 


5 BOOLEAN FLAG 


HEXBUF : 


OS 


2 


;HEX 


: BUFFER 


OPCODE: 


OS 


1 


\ CONTENTS OF BREAKPOINT LOCATION 


SADDRESS: 


DS 


2 


*ST ART ADORESS BUFFER 


STAX: 


OS 


13H 


;REG 


i STORAGE 


MOD VAR: 


OS 


30H 


jMODEL VARIABLE STORAGE 


MFLAG: 


OS 


1 


JMOOEL FLAG FOR SUBROUTINE FACTOR 


NS: 


OS 


1 


^COUNTER USEO TO CONTROL STORAGE 


KMFLAG: 


OS 


1 


i FLAG USEO IN WALG 


TEMP: 


OS 


2 


iTEMP VARIABLE 


RECV 


EQU 


D4H 


;RS- 


232 INPUT PORT 


XMIT 


EQU 


04H 


iRS- 


232 OUTPUT PORT 


RSSTAT 


EQU 


05H 


RS- 


232 STATUS PORT 


RSMOOE 


EQU 


06H 






RSCMD 


EQU 


07H 






PC REG 


EQU 


STAX 


>PC 


LOCATION IN STAX 


SPREG 


EGU 


ST AX +2 






IYREG 


EQU 


ST AX +4 


y IY 


LOCATION IN STAX 


IXREG 


EQU 


STAX+6 


>IX 


LOCATION IN STAX 


HLALT 


EQU 


STAX+8 


»HL 1 


LOCATION IN STAX 


OEALT 


EQU 


STAX+OAH 




>0E * LOCATION IN STAX 


BCALT 


EQU 


STAX+DCH 




>BC' LOCATION IN STAX 


AFALT 


EQU 


STAX+OEH 




* AF 1 LOCATION IN STAX 


HLREG 


EQU 


STAX+10H 




JHL LOCATION IN STAX 


DEREG 


EQU 


STAX+12H 




IDE LOCATION IN STAX 


BCREG 


EQU 


STAX+14H 




;BC LOCATION IN STAX 


AFREG 


EQU 


STAX+16H 




> AF LOCATION IN STAX 


R 


EQU 


MOOVAR 




,R (STEP INPUT) LOCATION IN MOOVAR 


CM 


EQU 


MODVAR+2 




>CM (MOOEL OUTPUT) LOCATION 


CMCF 


EQU 


MOOVAR+4 




>CM * CORRECTION FACTOR 


COOT 


EQU 


MODVAR+6 




jCDOT (DERIVATIVE OF CM) LOCATION 


CODOT 


EQU 


MODVAR+8 




jCDDOT (ACCELERATION) 


C0M1 


EQU 


MODVAR+DAH 


> PREVIOUS VALUE OF VELOCITY 


C00M1 


EQU 


MOOVAR+OCH 


^PREVIOUS VALUE OF ACCELERATION 


CSM1 


EQU 


MOOVAR+OEH 


> PREVIOUS VALUE OF PLANT OUTPUT 


CSM2 


EQU 


MODVAR+lOH 


•y(T-Z) VALUE OF OUTPUT PLANT 


N 


EQU 


MOOVAR+12H 


•, COUNTER 


V 


EQU 


M0DVAR+14H 


iVOLTAGE AT THE LIMITER OUTPUT 


KM 


EQU 


M0DVAR+16H 


i MOTOR GAIN CONSTANT 


COUNT 


EQU 


M0DVAR+13H 


i COUNTER 


CS 


EQU 


MOOVAR+1AH 


i ANALOG OUTPUT 


NUMBER 


EQU 


MOOVAR+1CH 


j DATA TO BE OISPLAYEO 


QUOT 


EQU 


M00VAR+1EH 


*, QUOTIENT 


ONES 


EQU 


MODVAR+20H 


y LSOIGIT OF A OECIMAL NUMBER 


TENS 


EGU 


MODVAR+22H 


i SECOND OIGIT OF A OECIMAL NUMBER 


HUNDREDS 


EQU 


M0DVAR+24H 


jTHIRD DIGIT 


THCUS 


EQU 


MOOVAR+26H 


j FOURTH OIGIT 


TTHOUS 


EQU 


MOOVAR+2 


8H 


> FIFTH OIGIT OF A DECIMAL NUMBER 


TEMPIY 


EQU 


MOOVAR+2AH 


•, TEMPORARY STORAGE OF IY REG. 


CF 


EQU 


M0DVAR+2CH 


iCGRRECTOR FACTOR 


NN 


EQU 


MOOVAR+2EH 


j COUNTER FOR WIKSTROM ALGORITHM 


RSTART30 


EQU 


0F7H 




^OPCODE FOR RST30 


FALSE 


EQU 


0 


^BOOLEAN VARIABLE 


TRUE 


EQU 


OFFH 


*, BOOLEAN VARIABLE 


BS 


EQU 


8 


y ASCII BACKSPACE 



100 



FWDARW 


EQU 


OCH * ASCII 


FOREWARD ARROW 


ESC 


EQU 


1BH >ASCII 


ESCAPE 


SPACE 


EQU 


20H >ASCII 


SPACE 


CR 


EQU 


ODH >ASCII 


CARRIAGE RETURN 


LF 


EQU 


OAH > ASCII 


LINE FEED 


> 

> 


RS-232 PORT CONFIGURATION WORDS 




MR1 


EQU 


OCEH 




MR2 


EQU 


7DH 




CMD 


EQU 


5 




> 


CSEG 






RESET: 


LD 


SP > 1600H 




> 


JP 


MONINIT 




ORG 


30H 




RST30 : 


JP 


TRAP30 




> 


ORG 


38H 




INTM1 : 
> 


JP 


09C0H 




ORG 


66H 




NMINT : 
> 


JP 


09A0H 




> 

> 


MONINIT PUSHES ALL THE REGISTERS ONTO THE STACK BEFORE 


> 


ENTERING THE 


MONITOR 






ORG 


100H 




MONINIT 


: LD 


A , MR 1 






OUT 


( RSMODE ) > A 






LD 


A,MR2 






OUT 


( RSMODE ) > A 






LD 


A, CMD 






OUT 


( RSCMD ) >A 






CALL 


SCRLF 


>MOVE CURSOR TO NEXT LINE 




LD 


IX,MCNMSG 


>SET PTR TO MON MESSAGE 




CALL 


MESSAGE 


>PRINT"HI ROBERTO, I AM READY 




CALL 


SCRLF 


JMOVE CURSOR TO NEXT LINE 




LD 


IX,TYPMSG 


•>SET POINTER TO TYPE MESSAGE 




CALL 


MESSAGE 


iPRINT n TYPE . . . E >D ,T ...” 




CALL 


SCRLF 




MONLOOP 


: CALL 


MONITOR 


> INVOKE MONITOR 




JR 


MONLOOP 


> LOOP FOREVER 


) 

MONITOR 


: LD 


l IXREG ) > IX 


>SAVE IX AT MONITOR ENTRY 




POP 


IX 


>GET PC AT MONITOR ENTRY 




LD 


( PCREG ) >IX 


>STORE PC IN STAX+PCDIS 




LD 


( SPREG ) >SP 


*SAVE SP AT MONITOR ENTRY 




LD 


( IYREG ) >IY 


>SAVE IY AT MONITOR ENTRY 




PUSH 


AF 


*,PUSH ASF 




POP 


IX 


*,GET AS F 




LD 


( AFREG ) >IX 


>STORE AF 




LD 


( BCREG ) >BC 


>STORE BC 




LD 


( DEREG ) , DE 


^STORE DE 




LD 


( HLREG ) ,HL 


jSTORE HL 




EX 


AF > AF * 






EXX 

PUSH 


AF 


*, PUSH A' £ F ' 




POP 


IX 


MX < — AF 1 




LD 


( AFALT ),IX 


>STORE AF' 




LD 


(3CALT ),BC 


*, STORE BC 1 




LD 


( DEALT )>DE 


>STORE DE* 




LD 


( HLALT ) ,HL 


iSTORE HL* 




IN 


A > ( RSSTAT ) 


jGET CONSOLE STATUS 




AND 


2 


>IS A CHAR READY 




CALL 


NZ> COMMAND 


VGO TO COMMAND DECODER 




LD 


IX, (AFALT) 


; RESTORE AF ' 
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PUSH 


IX 




POP 


AF 




LD 


BC , ( BCALT ) 


^RESTORE BC' 


LD 


DE, (DEALT) 


^RESTORE DE' 


LD 


HL , ( HLALT ) 


^RESTORE HL' 


EX 


AF , AF ' 


^RESTORE ALL ALT REGS 


EXX 






LD 


HL , ( HLREG ) 


^RESTORE HL 


LD 


DE , ( DEREG ) 


^RESTORE DE 


LD 


BC , ( BCREG 1 


^RESTORE BC 


LD 


IX , ( AFREG 1 


^RESTORE AF 


PUSH 


IX 




POP 


AF 




LD 


IY,( IYREG) 


^RESTORE IY 


LD 


SP , ( SPREG ) 


SRE STORE SP 


LD 


IX , ( PCREG ) 


S RESTORE PC 


PUSH 


IX 




LD 


IX, ( IXREG ) 


^RESTORE IX 



DS 1 

END 



> THIS PROGRAM DISPLAYS THE CONTENTS OF MEMORY FROM THE 

S STARTING ADDRESS TO THE END ADDRESS 

* 

.280 

PUBLIC GO, LIST, REG, REGDISP , GHEXERR ,DIS ,TRF , MOD, HELP 

EXTRN BACKSP ,BKPT ,BCUT ,BUFFIN ,CHAR ,CHGREGS , COMMA ,CR 

SXTRN EADDRESS, EAMSG, ECHO, ERRMSG, ESC , FALSE , FLAG, FWDARW 

EXTRN GETADDR ,GETCHAR ,GETSTRIN , HEXCNV ,HEXCONV ,HEXMSG , LINENO , MESSAGE 

EXTRN OPCODE ,REGMSG , RSTART30 ,SADDRESS ,SAMSG >SCRLF , SCROLL , SPACES 

EXTRN TEMP, TRUE , DISPLAY , TRANSFER , MODEL ,DISMSG >TRANMSG ,MODMSG 



EXTRN 


STAX, 


SPREG, PCREG, Al 


EXTRN 

S 

REGLENGHT 


H7,HS 




EQU 


8 


> 

GHEXERR: 


LD 


B,4 




CALL 


SPACES 




LD 


IX ,HEXMSG 




CALL 


MESSAGE 




CALL 


SCRLF 


GO: 


LD 


8,2 




CALL 


SPACES 




CALL 


GETSTRIN 




CALL 


HEXCONV 




JR 


C, GHEXERR 




LD 


(PCREG), DE 




XOR 


A 




CP 


(IX) 




JR 


Z, GOEXIT 




LD 


A, COMMA 




CP 


(HL) 




JR 


NZ, GOEXIT 




INC 


HL 




CEC 


( IX) 




CALL 


HEXCNV 




JR 


C, GHEXERR 




LD 


A , ( DE ) 




LD 


(OPCODE ) , A 




LD 


(BKPT ),DE 




LD 


A , RSTART30 




LD 


( DE ),A 


GOEXIT : 


CALL 

RET 


SCRLF 



IXREG ,IYREG ,AFALT ,H1,H2,H3,H4,H5,H6 



jLENGHT OF REGLIST 



> LOAD HEX CONVERSION MSG 



jSET 2 SPACES 

SPRINT 2 SPACES 

SGET CMD STRING FOR GO 

* CONVERT ASCII TO HEX 

* IF CARRY IS SET DISPLAY ERROR MSG 

jENTER START ADDRESS 

iCLEAR A 

S IS THERE A BREAKPOINT 
SNO, EXIT 
y A COMMA 

>IS CHARACTER A COMMA ? 

SlF IT IS NOT, EXIT 

S ADJUST PTR TO NEXT CHAR 

S ADJUST CHAR COUNT 

*, CONVERT ASCII TO HEX 

SlF CARRY IS SET DISPLAY ERROR MSG 

SGET CONTENTS OF BREAKPT 

SAND SAVE IN OPCODE 

SSAVE BREAKPOINT 

SGET OPCODE FOR RST30 

’, INJECT RST30 OPCODE 
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V 



LHEXERR : 


LD 


B,4 




CALL 


SPACES 




LD 


IX , HEXMSG 




CALL 


MESSAGE 




CALL 


SCRLF 


LIST: 


LD 


B,2 




CALL 


SPACES 




CALL 


GETSTRIN 




CALL 


HEXCONV 




JR 


C, LHEXERR 




LD 


(SADDRESS ),DE 




XOR 


A 




CP 


(IX) 




JR 


Z, LOADEND 




INC 


HL 




DEC 


(IX) 


LOADEND: 


CALL 


HEXCNV 




JR 


C, LHEXERR 




LD 


( EADDRESS ) >DE 




CALL 


SCRLF 


NEWLINE: 


CALL 


LINENO 




LD 


HL, (SADDRESS) 


GETABYTE: 


LD 


A , ( HL ) 




CALL 


BOUT 




LD 


A, ( FLAG) 




CP 


TRUE 




CALL 


Z, CHANGE 




LD 


3,2 




CALL 


SPACES 




LD 


DE,( EADDRESS) 




XOR 


A 




SBC 


HL >DE 




JR 


NC, LISTEXIT 




LD 


HL , ( SADDRESS) 




INC 


HL 




LD 


(SADDRESS ),HL 




LD 


A ,L 




AND 


OFH 




JR 


NZ, GETABYTE 




CALL 


SCRLF 




CALL 


SCROLL 




LD 


A, (CHAR) 




CP 


ESC 




JR 


Z, LISTEXIT 




JR 


NEWLINE 


LISTEXIT: 


CALL 


SCRLF 




RET 




V 

CHANGE : 


LD 


B,2 


CHGAGIN : 


CALL 


BACKSP 




CALL 


GETSTRIN 




LD 


A , ( BUFFIN ) 




CP 


0 




JR 


Z, NOENTRY 




LD 


B , A 




CP 


I 




JR 


Z, CHGAGIN 




LD 


(TEMP ) , A 




CALL 


HEXCONV 




LD 


HL,( SADDRESS) 




LD 


(HL),E 




LD 


A, (TEMP ) 




NEG 




NOENTRY: 


ADD 


A, 2 




JR 


Z ,CHANGEX 




LD 


B , A 




CALL 


P, SPACES 



V LOAD HEX CONVERSION MSG 



VSET 2 SPACES 

V PRINT 2 SPACES 

>GET CMD STRING FOR LIST 

V CONVERT ASCII ADDRESS 

VlF CARRY IS SET DISPLAY ERROR MSG 

VSTART ADDRESS <-- DE 

VCLEAR A 

VIS THERE AN END ADDRESS 
VNO , DEFAULT TO 0 

V ADJUST PTR TO NEXT CHAR 
V ADJUST CHAR COUNT 

*, CONVERT ASCII ADDRESS 

V IF CARRY IS SET DISPLAY ERROR MSG 
VEND ADDRESS <— DE 

VDISPLAY ADDRESS 
>GET MEMORY POINTER 
VGET MEMORY BYTE 
^DISPLAY MEMORY BYTE 

VIS THE CHANGE FLAG SET 
VYES , CHANGE A BYTE 
VSETUP FOR 2 SPACES 
V PRINT 2 SPACES 
V DE <-- END ADDRESS 
VCLEAR CARRY 
VIS START => END 
VNO, EXIT 

VGET MEMORY POINTER 
VlNCREMENT START ADDRESS 

VGET SADDRESS . LOW 
VIS THIS A NEW LINE 
VNO, GET A NEW BYTE 
VMOVE CURSOR TO NEW LINE 

V ST ART & STOP SCROLLING 
VGET SCROLL CHAR 

VIS IT AN ESCAPE 
VYES, EXIT 
V START A NEWLINE 
VNO, ADJUST CURSOR £ EXIT 



VSETUP FOR 2 BACK SPACES 
VBACK SPACE 2 SPACES 
VGET ANY NEW CHARACTERS 
VGET STRING LENGTH 
VIS STRING LENGTH = 0 



VIS STRING LENGTH <2 
V YES , DO IT AGAIN 
VSAVE STRING LENGTH 
VCONVERT BYTE TO HEX 
VRESTORE HL PTR 
VSTORE CHAR IN BYTE 
VSET CURSOR RESTORE BASE 
VNEGATE STRING LENGTH 
VADD 2 TO RESTORE BASE 
V I F 0 ADJUST EXIT 

V IF PLUS RESTORE CURSOR 
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CHANGEX: 


LD 


HL > ( SADDRESS ) 


^RESTORE HL BEFORE RETURN 




RET 






J 

REG: 


CALL 


SCRLF 






LD 


IX ,REGMSG 


jSETUP REG A MESSAGE 




CALL 


REGDISP 


j DISPLAY REGISTERS 




LD 


IX >CHGREGS 


jSETUP REG CHANGE MESSAGE 




CALL 


MESSAGE 


CENTER REG TO CHANGE" 




CALL 


SCRLF 






CALL 


GETCHAR 


jGET SELECTED REGISTER 




CALL 


ECHO 


jECHO REG NAME TO CRT 




LD 


A, (CHAR) 






LD 


(TEMP), A 






CP 


CR 


jNO CHANGE? 




JR 


2, REGEXIT 


jYES , EXIT 




CP 


"S" 


jCHANGE SP? 




JR 


2, CHGSP 


jYES , JUMP CHGSP 




CP 


"P" 


jCHANGE PC? 




JR 


2, CHGPC 


jYES , JUMP CHGPC 




CP 


"X" 


j CHANGE IX? 




JR 


2, CHGIX 


jYES, JUMP CHGIX 




CP 


iiyn 


jCHANGE IY? 




JR 


2, CHGIY 


jYES, JUMP CHGIY 




CALL 


GETCHAR 


jGET NEXT CHAR IN CMD 




CALL 


ECHO 






LD 


A, (CHAR ) 






CP 


it i ii 


jlS REG AN ALTERNATE 




JR 


Z, CHGALT 


jYES, CHANGE ALT REG SET 




CP 


CR 


jEND OF CMD? 




JR 


NZ, REGERR 


jNO , JUMP REGERR 


CHGREG: 


LD 


HL , AFREG+1 


jGET PTR TO REGS ON STAX 




JR 


LOADLIST 




CHGALT : 


LD 


HL , AFALT + 1 


jGET PTR TO REGS ON STAX 


LOADLIST : 


LD 


IX , REGLIST 


jGET IX TO "AFBZDZHZZ" 




LD 


B,REGLENGHT-1 


jSET REGLIST COUNT 




LD 


A, (TEMP ) 


JRETRIEVE REG NAME 


REGSCAN: 


CP 


(IX) 


jlS REG = SELECTED REG 




JR 


2, REGCONT 


jYES, OUTPUT CONTENTS 




INC 


IX 


j POINT TO NEXT REG 




DEC 


HL 


j POINT TO NEXT REG 




DJN2 


REGSCAN 


jGET NEXT REGLIST 




LD 


IX , ERRMSG 


jREG NOT FOUND GET ERRMSG 




CALL 


MESSAGE 


j "ERROR RE-ENTER" 


REGEXIT: 


CALL 

RET 


SCRLF 




REGERR: 


LD 


IX, ERRMSG 




> 

CHGSP : 


CALL 

RET 


MESSAGE 




LD 


HL ,SPREG+1 


jGET SP AT MON ENTRY 




JR 


REGCONT 


jGET NEH CONTENTS 


CHGPC : 


LD 


HL ,PCREG + I 


JGET PC AT MON ENTRY 




JR 


REGCONT 


jGET NEH CONTENTS 


CHGIX : 


LD 


HL , IXREG + 1 


jGET IX AT MON ENTRY 




JR 


REGCONT 


jGET NEH CONTENTS 


CHGIY : 


LD 


HL ,IYREG + 1 


jGET IY AT MON ENTRY 


REGCONT: 


PUSH 


HL 


JSAVE HL 




LD 


B ,4 






CALL 


SPACES 


jPRINT 4 SPACES 




CALL 


GETSTRIN 


jGET NEH REG CONTENTS 




CALL 


HEXCCNV 


jCONVERT CONTENTS TO HEX 




POP 


HL 


j RESTORE HL 




LD 


A, (TEMP ) 






CP 


"A" 


jlS REG A? 




JR 


2 , AORF 


jYES, GO TO AORF 




CP 


„ F " 


jlS REG F? 




JR 


2, AORF 


jYES, GO TO AORF 




LD 


A , D 


jGET HI BYTE OF HEXBUF 




LD 


( HL ) , A 


jLOAD REG PAIR HI BYTE 
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DEC 


HL 


AORF: 


LD 


A,E 




LD 


(HL),A 




CALL 


SCRLF 




JR 


REGEXIT 


> 

REGDISP: 


LD 


HL , AFREG+1 




LD 


C > 2 




CALL 


ONEREG 




LD 


C , 3 




CALL 


REGPAIR 




LD 


HL » IXREG + 1 




LD 


C,2 




CALL 


REGPAIR 




CALL 


SCRLF 




LD 


HL , AFALT + 1 




LD 


C,2 




CALL 


ONEREG 




LD 


C,3 




CALL 


REGPAIR 




LD 


HL >SPREG + 1 




LD 


C > 2 




CALL 


REGPAIR 


> 

ONEREG: 


CALL 

RET 


SCRLF 


CALL 


MESSAGE 




CALL 


REGDUMP 




INC 


IX 




DEC 


C 




JR 


NZ, ONEREG 




RET 




> 

REGPAIR: 


CALL 


MESSAGE 




CALL 


REGDUMP 




CALL 


REGDUMP 




INC 


IX 




DEC 


C 




JR 


NZ, REGPAIR 


> 

REGDUMP: 


RET 




LD 


A,(HL) 




CALL 


BOUT 




DEC 


HL 




RET 




DIS: 


CALL 


SCRLF 




LD 


IX,DISMSG 




CALL 


MESSAGE 




CALL 


SCRLF 




CALL 

RET 


DISPLAY 


TRF : 


CALL 


SCRLF 




LD 


IX,TRANMSG 




CALL 


MESSAGE 




CALL 


SCRLF 




CALL 

RET 


TRANSFER 


MOD: 


CALL 


SCRLF 




LD 


IX >MODMSG 




CALL 


MESSAGE 




CALL 


SCRLF 




CALL 

RET 


MODEL 


HELP: 


CALL 


SCRLF 




LD 


IX, HI 




CALL 


MESSAGE 




CALL 


SCRLF 




CALL 


SCRLF 




LD 


IX, H2 



iPOINT TO LON REG PAIR 
jGET LO BYTE OF HEXBUF 
> LOAD REG PAIR LON BYTE 
j OUT PUT CR AND LF 
>EXIT 

; POINT TO A 2 F IN STAX 
jSET LOOP FOR A AND F 
i DISPLAY A 3 F 
jSET FOR 3 REGS 
^DISPLAY BC,DE, l HL 
\ POINT TO IXREG IN STAX 
>SET FOR 3 REGS 
^DISPLAY BC,DE, a HL 

>POINT TO A' & F ' IN STAX 
* SET LOOP FOR A' AND F’ 
^DISPLAY A ' 2 F ' 
jSET FOR 3 REGS 
*, DISPLAY BC ' ,DE ' , S HL' 
jPOITN TO SP & PC 
>$ET FOR 2 REGS 
^DISPLAY SP S PC 
> GENE RATE CR S LF 



>"AF " 

^DISPLAY REG CONTENTS 
j POINT TO NEXT MSG 
•,DEC REG LOOP COUNTER 
;MORE REGS GO TO ONEREG 



> "HL 

^DISPLAY REG CONTENTS 
* DISPLAY REG CONTENTS 
i POINT TO NEXT MSG 
jDEC REG LOOP COUNTER 
iMORE REGS GO TO REGPAIR 



*GET REG 

j OUT PUT REG TO CRT 
> POINT TO NEXT REG 



*IX< — MESSAGE ADDRESS 
DISPLAY THE RESULTS" 

; DISPLAY RESULTS ON SCREEN 



>IX< MESSAGE ADDRESS 

> "TRANSFER MODEL TO RAM" 

^TRANSFER MODEL TO RAM (1000) 



>IX< — MESSAGE ADDRESS 
i" RUN YOUR MODEL" 

>RUN MODEL 
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CALL 


MESSAGE 


CALL 


SCRLF 


CALL 


SCRLF 


LD 


IX, H3 


CALL 


MESSAGE 


CALL 


SCRLF 


CALL 


SCRLF 


LD 


IX ,H<+ 


CALL 


MESSAGE 


CALL 


SCRLF 


CALL 


SCRLF 


LD 


IX, HS 


CALL 


MESSAGE 


CALL 


SCRLF 


CALL 


SCRLF 


LD 


IX, H6 


CALL 


MESSAGE 


CALL 


SCRLF 


CALL 


SCRLF 


LD 


IX, H7 


CALL 


MESSAGE 


CALL 


SCRLF 


CALL 


SCRLF 


LD 


IX, H8 


CALL 


MESSAGE 


CALL 


SCRLF 


CALL 

RET 


SCRLF 


DC 


" AFBZDZHZZ" 


DS 

END 


1 



V THIS PROGRAM DECODES COMMANDS AND INVOKES THE PROPER 

V COMMAND ROUTINES 
* 280 

PUBLIC COMMAND 

EXTRN CHAR , ECHO ,ERRMSG, FALSE , FLAG ,GETCHAR , GO , LIST , MESSAGE ,HELP 

EXTRN REG ,SCRLF , TRUE ,DIS >TRF ,MOD 



V 



COMMAND: CALL 


GETCHAR 


VGET A CHAR FROM CRT 


CALL 


ECHO 


VECHO CHAR BACK TO CRT 


LD 


A , 1 CHAR ) 


VGET CMD CHAR 


CP 


'G' 


VIS CHAR A "G" 


JP 


Z ,GO 


VYES, EXECUTE CODE 


LD 


HL ,FLAG 




LD 


( HL ) ,TRUE 


VSET CHANGE FLAG 


CP 


* C ' 


VIS CHAR A "C M 


JP 


Z , LIST 


VYES, CHANGE MEMORY 


LD 


(HL), FALSE 


vCLEAR CHANGE FLAG 


CP 


•L’ 


VIS CHAR A "S" 


JP 


Z , LIST 


>NQ , LIST MEMORY 


CP 


'R' 


VIS CHAR AN "R" 


JP 


Z,REG 


VYES, DISPLAY REGS 


CP 


' D ' 


VIS CHARACTER A "D"? 


JP 


Z,DIS 


VYES, DISPLAY RESULTS 


CP 


1 T 1 


VIS CHARACTER A "T"? 


JP 


Z ,TRF 


VTRANSFER MODEL TO RAM 


CP 


' E 1 


VIS CHARACTER AN "E"? 


JP 


Z,MOD 


VRUN MODEL 


CP 


'M' 


VIS CHARACTER AN "M" ? 


JP 


Z , 1000H 


VGO TO RAM, ADDRESS 1000H 


CP 


• H ' 


Vis CHARACTER AN "H" ? 


JP 


Z ,HE LP 


VlF YES, GO TO HELP (IN LIST) 


LD 


IX ,ERRMSG 


vGET ERROR MESSAGE PTR 


CALL 


MESSAGE 


V PRINT "ERROR RE-ENTER" 


CALL 


SCRLF 


VMOVE CURSOR TO NEXT LINE 


RET 






END 






V THIS PROGRAM 


DECODES COMMANDS 


AND INVOKES THE PROPER 



106 



COMMAND ROUTINES 



. Z80 
PUBLIC 
EXTRN 
EXTRN 
> 

COMMAND: 



J 

. Z80 
EXTRN 
PUBLIC 
PUBLIC 
NULL 

y 

MESSAGE 



MSGRET: 

CHGREGS 



EAMSG : 
ERRMSG 
HEXMSG 
MONMSG 
REGMSG 



SAMSG: 
TYPMSG : 



COMMAND 

CHAR, ECHO, ERRMSG, FALSE , FLAG, GETCHAR, GO, LIST , MESSAGE ,HELP 
REG, SCRLF, TRUE ,DIS,TRF, MOD 



CALL 


GETCHAR 


JGET A CHAR FROM CRT 


CALL 


ECHO 


;ECHO CHAR BACK TO CRT 


LD 


A, (CHAR) 


jGET CMD CHAR 


CP 


1 G 1 


ilS CHAR A "G" 


JP 


2, GO 


^YES , EXECUTE CODE 


LD 


HL , FLAG 




LD 


(HL ),TRUE 


iSET CHANGE FLAG 


CP 


•C' 


jIS CHAR A "C" 


JP 


Z , LIST 


jYES , CHANGE MEMORY 


LD 


(HL), FALSE 


jCLEAR CHANGE FLAG 


CP 


'L' 


;IS CHAR A "S" 


JP 


2, LIST 


jNO , LIST MEMORY 


CP 


' R ' 


ilS CHAR AN "R" 


JP 


2, REG 


jYES , DISPLAY REGS 


CP 


’D' 


jIS CHARACTER A "D"? 


JP 


2 ,DIS 


>YES, DISPLAY RESULTS 


CP 


' T ' 


as CHARACTER A "T"? 


JP 


Z,TRF 


^TRANSFER MODEL TO RAM 


CP 


' E ‘ 


ilS CHARACTER AN "E"? 


JP 


Z ,MOD 


5 RUN MODEL 


CP 


' M ' 


jIS CHARACTER AN "M" ? 


JP 


Z , 1000H 


jGO TO RAM, ADDRESS 1000H 


CP 


•H' 


as CHARACTER AN "H" ? 


JP 


Z , HELP 


5 IF YES, GO TO HELP (IN LIST) 


LD 


IX, ERRMSG 


jGET ERROR MESSAGE PTR 


CALL 


MESSAGE 


jPRINT "ERROR RE-ENTER" 


CALL 


SCRLF 


jMQVE CURSOR TO NEXT LINE 


RET 






END 







THIS PROGRAM OUTPUTS MESSAGES TO THE CRT SCREEN 



ECHO 

CHGREGS , EAMSG , ERRMSG , HEXMSG , MESSAGE , MONMSG , REGMSG , SAMSG 
TRANMSG ,MODMSG , HELLO ,DISMSG , TYPMSG , HI ,H2 ,H3 ,H4 ,H5 ,H 6 ,H7 ,H 8 
EQU 0 5 ASCI I NULL SYMBOL 



LD 

CP 

JR 

CALL 

INC 

JR 

RET 

DC 

DC 

DB 

DC 

DB 

DC 

DB 

DC 

DB 

DC 

DB 

DB 

DB 

DB 

DB 

DC 

DB 

DC 



A, (IX) 
NULL 

2, MSGRET 

ECHO 

IX 

MESSAGE 



*,GET MESSAGE CHAR 

US CHAR = NULL 

>YES , RETURN 

•, OUTPUT CHAR TO CONSOLE 

•INCREMENT MESSAGE PTR 

>GET ANOTHER CHARACTER 



"ENTER REGISTER YOU HANT TO CHANGE" 

" [A,F ,B(BC ),D( DE ),H( HL ),S(SP),P( PC ) 1" 

NULL 

"END ADDRESS " 

NULL 

"ERROR RE-ENTER" 

NULL 

"HEX CONVERSION ERROR ... RE -ENTER" 

NULL 

"AUTOADAPTIVE CONTROL FOR A ROBOT ARM" 

NULL 

"A = ",NULL," F = " ,NULL , " BC = ",NULL," DE =" 
NULL," HL=" ,NULL , " IX=",NULL," IY=",NULL 
"A 1 ", NULL," F ' " ,NULL ," BC'",NULL," DE ' " 
NULL," HL 1 " ,NULL , " SP=",NULL," PC=",NULL 
"START ADDRESS " 

NULL 

"TYPE ' E ' TO RUN MODEL, " 
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DC 


'■ 1 D 1 TO DISPLAY THE RESULTS, " 




DC 


"•H 1 TO GET HELP." 




DB 


NULL 


TRANMSG : 


DC 


"TRANSFER MODEL FROM EPROM TO RAM ADDRESS 1000" 




DB 


NULL 


DISMSG: 


DC 


"DISPLAY RESULTS" 




DB 


NULL 


MODMSG : 


DC 


"RUN MODEL" 




DB 


NULL 


HELLO: 


DC 


"PLEASE ENTER ANGLE POSITION. MAXIMUM IS 7F" 




DB 


NULL 


HI: 


DC 


"I. TO RUN THE PROGRAM, TYPE <E>. ENTER ANGLE ( HEX ) , " 




DC 


"RESET THE INTEGRATORS IN THE ANALOG PLANT AND HIT" 




DC 


"<RETURN>. TO STOP THE PROGRAM, PRESS THE RESET SWITCH" 




DB 


NULL 


H2: 


DC 


"2. TO DISPLAY THE RESULTS OFF LINE (LAST RUN), TYPE <D>" 




DB 


NULL 


H3 : 


DC 


"3. TO TRANSFER THE PROGRAM TO RAM (AD. 1000H),TYPE <T>" 




DB 


NULL 


m: 


DC 


"4. TO RUN THE PROGRAM IN THE RAM, TYPE <M>." 




DB 


NULL 


H5 : 


DC 


"5. TO LIST THE MEMORY FROM ADDRESS XXXX TO YYYY , TYPE:" 




DC 


" 1 L<RET>XXXX ,YYYY<RET> ' " 




DB 


NULL 


H6 : 


DC 


"6. TO CHANGE DATA OR ENTER MACHINE LANGUAGE PROGRAM" 




DC 


"INTO RAM BETWEEN THE ADRESSES XXXX AND YYYY, TYPE:" 




DC 


" 'C<RET>XXXX,YYYY<RET>. TYPE <RET> TO BROWSE THE " 




DC 


"MEMORY" 




DB 


NULL 


H7 : 


DC 


"7. TO RUN A PROGRAM IN THE RAM TYPE : G<RET>XXXX ,ZZZZ" 




DC 


"<RET> WHERE ZZZZ IS THE BREAKPOINT OF THE PROGRAM." 




DC 


"THE CPU REGISTERS WILL BE SHOWN ON THE SCREEN." 




DB 


NULL 


H8: 


DC 


"8. TO SEE THE CPU REGISTERS, TYPE <R>." 




DB 


NULL 




END 





* 

jTHIS PROGRAM CONTAINS THE ROUTINES TO GET CHARACTERS FROM THE CRT 



^KEYBOARD AND SEND THEM TO THE SCREEN. FILE IS "CONSOLE" 
> 



EXTRN 


CHAR , REC ,RSSTAT ,XMIT 




PUBLIC 


GETCHAR 


, ECHO 




GETCHAR: 


IN 


A , ( RSSTAT ) 


VGET CONSOLE STATUS 




AND 


2 


ilS A CHAR READY ? 




JR 


2, GETCHAR 


} NO , CHECK AGAIN 




IN 


A , ( RECV ) 


> YES , GET RS232 DATA 




AND 


7FH 


^PARITY STRIP 




LD 


(CHAR ) , A 


jSTORE INPUT IN CHAR 




RET 






ECHO: 


LD 


E,A 


jTEMP CHAR STORE 


CKAGIN : 


IN 


A , ( RSSTAT ) 


>GET CONSOLE STATUS 




AND 


1 


*IS XMIT READY ? 




JR 


Z, CKAGIN 


JNO, CHECK AGAIN 




LD 


A , E 






OUT 


( XMIT ) , A 


;YES , SEND DATA OUT 



RET 

DS 1 

END 
i 

V THIS PROGRAM CONVERTS THE STRING IN BUFFIN INTO A HEXIDECIMAL NUMBER 



EXT 

PUBLIC 


3UFFIN, 

HEXCONV 


HEXSHIFT,LF, SEVEN 
,HEXCNV, COMMA 


, THIRTY 


V 

CLEAR 


EQU 


OOH 


V INITIALIZATION VALUE 


COMMA 


EQU 


2CH 


i ASCI I COMMA 


HT 


EQU 


09H 


i ASCII HORIZONTAL TABULATION 


DLE 


EQU 


10H 


i ASCII DATA LINK ESCAPE 



10S 






HEXCONV : 


LD 


HL ,BUFFIN + 1 


* INITIATE BUFFIN PONITER TO BUFFIN(l) 




CALL 

RET 


HEXCNV 


> CONVERT THE START ADDRESS TO HEX 


5 

y 


THIS ROUTINE PERFORMS THE 


ASCII TO HEX CONVERSION 


HEXCNV : 


LD 


DE, CLEAR 


jCLEAR HEXIDECIMAL REGISTERS 




LD 


IX, BUFFIN 


’ySET IX REG AS A STRING LENGTH POINTER 




LD 


A,( IX) 


EVALUATE STRING LENGTH 




CP 


CLEAR 


jIS THE STRING LENGTH EQUAL TO ZERO 




JR 


Z, EMPTY 


> IF LENGTH EQUALS ZERO EXIT ROUTINE 


HEXLOOP : 


LD 


A,(HL) 


>GET CHARACTER FROM BUFFIN 




CP 


COMMA 


jIS CHARACTER A COMMA ? 




JR 


Z, EMPTY 


aF IT IS EXIT ROUTINE 




SUB 


THIRTY 


yA <-- CHAR -30H 




LD 


(HL),A 


jCHAR <— A REG 




CP 


LF 


aS CHARACTER OAH ? 




JP 


M, ZEROCK 


aF IS LESS THAN OAH GO TO ZEROCK 




SUB 


SEVEN 


> A <-- CHAR - 07H 




LD 


(HL),A 


iCHAR A REG 




CP 


HT 


as CHARACTER A 09H ? 




JP 


M, HEXERR 


aF IS LESS THAN 09H GO TO HEXERR 




CP 


DLE 


VIS CHARACTER A 10H ? 




JP 


P, HEXERR 


aF GREATER THAN 10H GO TO HEXERR 


ZEROCK: 


CP 


CLEAR 


as CHARACTER A ZERO ? 




JP 


M, HEXERR 


aF LESS THAN ZERO GO TO HEXERR 




CALL 


HEXSHIFT 


^PROVIDE THE SHIFT IN THE HEX REGISTER 




INC 


HL 


aNCREMENT BUFFIN POINTER 




DEC 


( IX) 


^DECREMENT STRING LENGTH 




XOR 


A 


jCLEAR ACCUMULATOR 




CP 


( IX) 


as THERE MORE CHARACTERS ? 




JP 


NZ, HEXLOOP 


aF YES GET NEXT CHARACTER 


EMPTY: 


OR 


A 


•,NO ERROR ,SO CLEAR CARRY 


ENDCONV : 


RET 






HEXERR: 


SCF 




JERROR ,SO SET CARRY 


\ 


JR 


ENDCONV 


jEXIT SUBROUTINE 


DS I 
END 









\ THIS PROGRAM PROVIDES THE SHIFT OF THE HEX ADDRESS INTO THE HEX REGISTERS 



y 

PUBLIC HEXSHIFT 



HEXSHIFT: 


LD 


B,04H 


>B <— 04 




OR 


A 


jCLEAR CARRY 


SHIFT: 


SLA 


E 


iSHIFT LEFT E CONTENTS THROUGH CARRY 




RL 


D 


$ ROTATE LEFT D CONTENTS FROM CARRY 




DJNZ 


SHIFT 


j ARE THE FOUR SHIFTS COMPLETED ? 




LD 


A , ( HL ) 


; A <— CONVERTED CHARACTER 




OR 


E 


^SUPERIMPOSE THE CONTENTS OF E AND A 




LD 


E,A 


jE <— A REG 




RET 






> 


DS 


I 






END 






> THIS 


PROGRAM GETS A 


STRING OF CHARACTERS FROM THE CRT THAT HILL BE 


> 




CONCATENATED 


BY CONCAT 


EXT 


BUFFIN, 


CONCAT >CR >ECHO 


, GETCHAR 


PU3LIC 

> 

ZERO 


GETSTRIN 




EQU 


00H 


aNITIAL VALUE OF COUNTER 


y 

GETSTRIN: 


LD 


C,ZERO 


j COUNTER INITIALIZATION 




LD 


HL, BUFFIN 


; INITIATE BUFFIN POINTER 




INC 


HL 


iPLACE POINTER INTO BUFFIN(l) 


BUILD: 


CALL 


GETCHAR 


y READ CHARACTER FROM CRT 




CP 


CR 


as THE CHARACTER A CARRIAGE RETURN 




JR 


Z ,STRINGEX 


aF IT IS JUMP TO STINGEX 
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CALL 
CALL 
JR 

STRINGEX: LD 

LO 
RET 

DS 1 
END 

> THIS PROGRAM DISPLAY THE STARTING ADDRESS OF THE CURRENT 

> LINE 
J 

. Z30 

PUBLIC LINENO 

EXTRN BOUT, SADDRESS, SPACES 



ECHO ^DISPLAY CHARACTER 

CONCAT ^CONCATENATE THIS CHAR WITH THE OTHERS 

BUILD *,GET NEXT CHARACTER 

A,C $ A REG <— NUMBER OF CHAR IN STRING 

( BUFFIN ) , A iSTRING LENGTH IS STORED IN BUFFIN(O) 



LINENO: 






LD 


A , ( SADDRESS + 1 ) 


JGET MSB CURRENT ADDRESS 


CALL 


BOUT 


J DISPLAY HI ADDRESS BYTE 


LD 


A, (SADDRESS) 


jGET LSB CURRENT ADDRESS 


CALL 


BOUT 


jDISPLAY LOW ADDRESS BYTE 


LD 


B,4 


jSETUP FOR A SPACES 


CALL 


SPACES 


JPRINT A SPACES 


RET 






DS 


1 




END 







THIS PROGRAM SENDS OUT A CARRIAGE RETURN AND LINE FEED 



> 

.280 

PUBLIC BACKSP ,SCRLF , SCROLL , SPACES 

EXTRN BS, CHAR, CR, ECHO, ESC ,GETCHAR , LF , RSSTAT 



EXTRN 


FWDARW 


> 

BACKSP: 


LD 


A ,BS 




CALL 


ECHO 




DJN2 


BACKSP 




RET 




> 

SCRLF : 


LD 


A,CR 




CALL 


ECHO 




LD 


A , LF 




CALL 


ECHO 




RET 




\ 

SPACES: 


LD 


A, FWDARW 




CALL 


ECHO 




DJN2 


SPACES 




RET 




> 

SCROLL: 


IN 


A , ( RSSTAT ) 




CP 


2 




JR 


N2, SEXIT 




CALL 


GETCHAR 




LD 


A, (CHAR ) 




CP 


ESC 




JR 


2, SEXIT 


PAUSECK: 


: IN 


A , ( RSSTAT 1 




CP 


2 




JR 


N2, PAUSECK 




CALL 


GETCHAR 


SEXIT: 


RET 






DS 


1 




END 




> 


THIS PROGRAM 


GETS AN ASCII 






>A <— BACK SPACE 
JSEND SPACE TO CRT 
J YES, GOTO SPACES 



\X <— ASCII RETURN 
jSEND A RETURN TO CRT 
y A <— ASCII LINE FEED 
JSEND A LINE FEED TO CRT 



j A <— FOREWARD ARROW 
*,SEND SPACE TO CRT 
j YES , GOTO SPACES 



jGET CONSOLE STATUS 
jIS A CHAR READY 
jNO, EXIT 

J YES , GET THE CHARACTER 
y A <~ CHAR 

\IS THE CHAR AN ESCAPE 
J YES , TERMINATE SCROLL 
jGET CONSOLE STATUS 
yIS A CHAR READY 
>N0> CONTINUE PAUSE 
jCLEAR REC REG 



ADDRESS AND CONVERTS IT TO HEX 



.280 

PU3LIC GETADDR 

EXTRN BUFFIN, GETSTRIN ,HEXCONV , MESSAGE ,SCRLF 
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* 



GETADDR : 


CALL 


SCRLF 




jMOVE CURSOR TO NEXT LINE 




CALL 


MESSAGE 




SPRINT ADDRESS MESSAGE 




CALL 


GETSTRIN 




)GET ASCII ADDRESS 




CALL 


SCRLF 




jMOVE CURSOR TO NEXT LINE 




CALL 


HEXCONV 




> CONVERT ADDRESS TO HEX 




JR 


C, GETADDR 




\ ERROR > GET NEW ADDRESS 


ADDREXIT 


: RET 










DS 


1 








END 








i THIS 


PROGRAM IS USED BY GETSTRIN 


TO 


CONCATENATE THE CHARATER ONTO THE 




ASCII STRING BEING FORMED 


IN THE INPUT BUFFER 


> 

EXT 

PUBLIC 

> 

CONCAT : 


CHAR ,BS 
CONCAT 








CP 


BS 




MS THE CHARACTER A BACK SPACE ? 




JR 


2, CORRECT 




>IF IT IS JUMP TO CORRECT 




LD 


A, (CHAR) 




>A REG <— LOADED CHARACTER 




LD 


(HL),A 




*STORE CHARACTER IN BUFFIN 




INC 


C 




^INCREMENT COUNTER 




INC 


HL 




jSET POINTER TO NEXT BUFFIN POSITION 




RET 








CORRECT: 


LDD 






jHL <~ HL-1 ,BC <— BC-1 


\ 


RET 








DS I 

END 










\ 

\ 

EXT 


THIS PROGRAM 


CONVERTS THE 


HEX 


: CONTENTS OF A INTO ASCII 


TEMP, ECHO 






PU3LIC 

\ 

MASK 


BOUT, THIRTY, SEVEN, ASCONV 


EQU 


OFH 




j ASCII MASK 


THIRTY 


EQU 


30H 




j ASCII 30 


COLON 


EQU 


3AH 




^ASCII : 


SEVEN 


EQU 


07H 




j ASCII 7 



BOUT: 


LD 


(TEMP), A 




SRL 


A 




SRL 


A 




SRL 


A 




SRL 


A 




CALL 


ASCONV 




LD 


A, (TEMP ) 




AND 


MASK 




CALL 


ASCONV 




RET 





>MAKE TEMPORARY COPY OF ACCUMULATOR 
> FIRST SHIFT RIGHT OF A CONTENTS 
^SECOND SHIFT RIGHT OF A CONTENTS 
jTHIRD SHIFT RIGHT OF A CONTENTS 
j FOURTH AND LAST SHIFT RIGHT 
>CONVERSION OF MS NIBBLE 
>GET TEMPORARY COPY OF A 
jMASK OFF MS NIBBLE 
^CONVERSION OF LS NIBBLE 
j RETURN TO CALLING ROUTINE 



> THIS SUBROUTINE WORKS WITH 'BOUT' TO PERFORM THE HEX TO ASCII CONVERSION 



ASCONV: 


ADD 


A, THIRTY 


j ADD 30H TO HEX NIBBLE 






CP 


COLON 


^COMPARE THE RESULT OF SUM WITH 


COLON 




JP 


M, ASCOUT 


*IF IT IS LESS THEN COLON JP TO 


ASCOUT 




ADD 


A, SEVEN 


* ADD 7 FOR A-F OFF SET 




ASCOUT : 


CALL 


ECHO 


^DISPLAY THE ASCII CHARACTER 




> 


RET 




>GO BACK TO ‘BOUT’ 




DS 


1 








END 








) 

) 

EXT 


THIS PROGRAM RESTARTS THE 


MONITOR AFTER A BREAKPOINT 




BKPT, OPCODE ,REGDISP,REGMSG, MONLOOP , MONITOR 




PUBLIC 

> 

TRAP30 : 


TRAP30 








CALL 


MONITOR 


>SAVE REGISTERS 






LD 


A, (OPCODE ) 


> A <— OPCODE OF BREAKPOINT POSITION 




LD 


DE , ( BKPT ) 


> DE< — ADDRESS OF BREAKPOINT 






LD 


( DE ) ,A 


j RESTORE OPCODE IN THE PROGRAM 
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LD 


IX,REGMSG 


^PREPARE 


TO DISPLAY REGISTERS 


CALL 


REGDISP 


^DISPLAY 


REGISTERS 


JP 


MON LOOP 


>GO TO MONLOOP AT MAIN 


RET 








DS 


1 






END 









APPENDIX C 

EQUIPMENT AND OPERATIONAL PROCEDURES 



1. EQUIPMENT 

The experimental system consists of the following parts: 

1 Three protoboards for the microprocessor, extra memories (data memories) and 
analog plant 

2. One video terminal 

3. One +5 V / 5 A power supply 

4. One -5 V / 300 mA power supply 

5. One +12 V / 300 mA power supply 

6. One ± 15 V/ 1 A power supply 

7. One oscilloscope for measuring the analog output. 

2. PROCEDURE 

In the actual configuration the objective of the hardware is to receive a 
commanded input from the keyboard (robot arm angle to be displaced) and provide the 
corresponding voltage at the plant output. This voltage represents the actual 
displacement of the robot arm and is monitored by the oscilloscope at the plant 
output. The commanded input (hexadecimal), when converted to decimal represents a 
multiple of 2.23 degrees. The minimum input allowed is 1 and the maximum is 7F 
(hexadecimal). In decimal they represent inputs from 1 to 127 and in degrees they are 
equivalent to angles between 2.23 to 284.2 dgrees, respectively. 

The operational procedure to run the system, in a step by step basis can be 
described as follows : 

1. Turn on the main power, power supplies, monitor and oscilloscope. 

2. Connect one channel of the oscilloscope to the plant output (CS). A second 
channel can be used to observe the plant input (V). 

3. Reset the microprocessor by pressing the reset switch. The screen will displav 
three options (execution, display andlielp). Hit <E> to run the program. 

4. The program will ask for the angle input. Type an hexadecimal number less or 
equal to 7PH (decimal 127). Adjust the oscilloscope scale accordingly. The 
biggest voltage will be equal to the decimal input multiplied by 0.039 Volts. 

5. Reset the integrators in the analog plant, the last integrator switch must be 
released last to guarantee zero output at the beginning ofthe program. 

6. Type <ret> right after releasing the reset switch. 
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7 . 



The program will run and the plant output can be observed at the oscilloscope. 
The voltage on the oscilloscope represents the angle position in radians. 

S. Reset the microprocessor. 

9. Tvpe <D> on the keyboard to displav the results. As explained in Appendix 

C the variables will be' displayed in eiaht columns. From left to richt they will 

be : Error. XDOT. XDOTE. 'CDDOT. CDOT. CM. CS and NN~( number of 
loops accomplished by the program up to that row). 

10. To scroll up the rows and look at some more data, hit any key. 

11. At the end of the data memory the screen will show an error message to 

indicate that there is no more data ayailable. To look at the data aaain. “reset 
the micro and type < D> . 
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